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INTRODUCTION 


RESEARCH PROPOSED 


Background: 

The research covered by this grant was aimed at the development 
of practical tools which can extend the state of the art of moving 
base flight simulation for research and training purposes. Our pri- 
mary consideration is the use of visual and vestibular cues to mini- 
mize the actual motion of the simulator itself. 

Over the last several years, we have taken a variety of approaches 
to this problem. For the period of this grant, we planned to continue 
our investigation of optimum programming of motion cues based on our 
physiological model of the vestibular system to yield "ideal washout 
logic" for any given simulator constraints. 

Specifically, we planned the evaluation of the two washout 
logics in use at the Langley Research Center facility utilizing 
Ormsby's (1974, 1976) model of perception based on vestibular cues 
in hopes that this model will prove successful in predicting the 
benefits of these logics without extensive pilot testing. The com- 
puter simulation based on the Ormsby model as used in the washout 
evaluation would be extensively documented. We planned to work 
with the staff of the Langley Simulation Group in rewriting our 
PDP-11 /RT-11 FORTRAN IV based program so that it will run on the 
Langley CDC-175 computer. 
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Analytical Evaluation of Washout Circuits; 

The use of linear and nonlinear adaptive washout logic at the 
Langley Research Center has shown that the nonlinear adaptive washout 
logic rates at least one category higher than the linear washout in 
terms of overall airplane feel. This is felt to be caused by the 
elimination of the anomalous rate cues present in the system with 
linear washout logic. 

We had proposed to analytically investigate the differences In 
these two washout systems using the Ormsby model for vestibular per- 
ception. It is hoped that the differences in predicting response 
will be such that the desirability of the nonlinear system is 
apparent. Such a test result would enhance the validity of the 
model as a predictor and make it available for general washout 
evaluation purposes. 

The actual evaluation was planned as follows: taking a typical 

landing pattern as a nominal test and recording actual Vision and 
Motion Simulator (VMS) cab motions imposed as delivered by each of 
these washout circuits, we would run both of the motion profiles 
through the model to develop a prediction of the pilot perception 
of orientation for each washout circuit. These perceived orientations 
would then be compared with the predicted tpilot perceptions in flight 
as calculated by running the simulated airplane accerations rather 
than the simulator accelerations through the same model. 
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Finally, the simulation validation program based on the Ormsby 
model was to be implemented on the computer at Langley Research 
Center. All of these goals were accomplished. 

THE RESEARCH 

Use of Washout and Visual Cues in Simulation: 

Constraints in position, velocity and acceleration of a simu- 
lator limit the capability of producing a desired motion exactly. 

The problem is to present the sensations of a wide range of motion, 
and to do this in a very limited space. This problem is solved with 
the use of washout filters in each axis of motion, in order to attenu- 
ate the desired motion until it falls within the constraints of the 
simulator. 

An important aspect of motion simulation has not yet been 
mentioned - the visual cues available to detect motion. Peripheral 
visual cues seem to be the most important in presenting the sensation 
of motion. The peripheral field may be stimulated by a moving pattern 
of stripes or dots, or by an actual "out-the-window" cockpit view. 

Taken together, washout filters and visual stimulation perform 
the function of simuation in which motions seem to go beyond the 
constraints of the simulator. The motion is duplicated to the point 
of constraint in a given axis. Then the washout filter takes over 
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and attenuates the motion to meet the constraint. Meanwhile, the 
visual field is stimulated so as to give the impression of continued 
motion, motion beyond the capability of the simulator. In this way, 
a wide range of motions can be simulated using a very restricted 
motion base. 

This research tried to answer the following questions: 

Can the observed differences in' simulation 
fidelity between two filters be explained 
using a physiological model of human 
dynamic orientation? 

What are the implications of this model - 
as a drawing board tool for simulator design? 

The two filters of interest in this comparative study are 
the following: 

A linear filter, essentially a Schmidt and Conrad 
coordinated washout. 

A nonlinear filter, coordinated adaptive washout. 

Basically, the two filters are versions of the Schmidt and Conrad 
coordinated washout. This scheme uses washout filters in the three 
translational axes, and only indirectly washes out the angular motion. 
The primary difference between the linear and nonlinear schemes is in 
the type of translational washout filters employed. The linear scheme 
uses second order classical washout filters in the three axes, while 
the nonlinear scheme uses coordinated adaptive filters for longitu- 
dinal and lalteral washout and digital controllers for vertical washout. 



5 


These schemes differ in their presentation of the rate cues, for 
a pulse input. The linear scheme presents an anomalous rate cue 
when the pulse returns to zero. This behavior is not observed vnth 
the nonlinear scheme. 

The Physiological Model: 

A model which predicts human perceptual response to motion 
stimuli has been developed at our Laboratory by Ormsby. The model, 
which exists as a FORTRAN computer program, is based on the known 
physiology of the. vestibular system. While little is known about 
the processing of the specific forces and angular accelerations 
received from the vestibular organs, the simplifying assumptions 
made about this process produce a model which agrees with available 
neurophysiological and physiological data. 


DATA AND RESULTS 

The data used in this work consists of four runs made with a 
linear or a nonlinear washout on the Langley simulator. Not only 
were the simulated motions recorded, but also the commanded motions 
of the aircraft. This allows evaluation of both the computer simu- 
lation of the motion and the actual simulator motion. This data 
was recorded at Langley on the CDC 6600 computer. For each of the 
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four cases there are two simulated motion histories and one 
commanded motion history. 

The input to the Ormsby model is a subroutine known as STIM. 

The input to STIM is the time in seconds into the motion history.. 

This is computed in the main program. The output from STIM consists 
of three vectors - a specific force vector in g‘s, a unit vector in 
the direction of gravity in g's, and an angular velocity vector in 
radians/second. 

The output of the program is discussed below for each individual 

cue. 

Aileron Roll Cues: 

Time histories of perceived angular velocity in response to 
aileron roll cues were studied using” both linear and nonlinear 
washout schemes. In each case, the perceived motion is approxi- 
mately the same for the first 13 seconds. The angular velocity 
rises gradually to a peak of 0.6 rad/sec (3.5 deg/sec). This is 
consistent iwith the expected response to the 5 deg/sec input roll 
velocity of the pulse-type aileron cue. It is after this peak 
perceived ve-looi-ty is reached that- the interesting- d-i-fferences -- 
occur. 

It is just at 13 seconds when the second pulse is input. The 
linear and nonlinear washouts cause the perceived velocity to change 
direction. In the linear case, this change in direction does not 
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occur until the end of the run, while in the nonlinear case it 
occurs at 15 seconds. In both cases, there is apparent confusion 
of direction. Just as there was in the first pulse, there should 
be a delay before the perceived angular velocity begins to return 
to zero. The experiment actually ends too soon, so that the zero 
level is never reached. 

A real difference can be seen in comparing the simulated 
cases with the commanded case. The commanded case behaves as pre- 
dicted — there is a gradual increase to the maximum perceived 
angular velocity, and then a leveling off. Presumably, if the 
experiment had been carried past the second pulse, there would 
be a gradual return to zero in angular velocity. 

In this case, then, the nonlinear filter acts to contain the 
confused perception involved in transferring the second pulse to 
the motion base. While it performs better than the linear filter, 
it presents motion cues which are not quite able to duplicate the 
desired motion perception. 

Aileron Yaw Cues: 

The perceived angular velocities output from the Ormsby model 
were also studied. In this case, the difference between the linear 
and nonlinear washouts is evident. Again, the first 13 seconds for 
each case are about the same — the expected response -to a pulse 
input is the slow rise to a maximum angular velocity, then a leveling 
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off. This is the same, response observed for the roll cues. 

Thirteen seconds into the motion history, the second pulse 
is introduced. In the case of the roll cues, the motion trans- 
ferred to the simulator was rather rough. Bilt for the yaw cues, 
the simulation was very close to the desired motion. 

As before, the commanded motion to the simulator is smooth 
and presents the expected response. A comparison shows that the 
nonlinear filter presented the second pulse with very little dis- 
turbance, while the linear filter caused a noticeable discontinuity 
in the motion. This is the anomalous rate cue which pilots have 
reported. 


Rudder Roll Cue: 

The situation here is different than the previous aileron; 
cases, simply because the motion history in the rudder cue cases 
is much more complicated than in the. aileron cases. It is not 
clear that the Ormsby- model is equipped to handle such^-rapidly 
varying motion histories, and this must be kept in mind during 
the analysis. 
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It does appear, however, that even in this more complex case, 
the nonlinear filter is able to contain the confused perceptions 
associated with transferring the pulse train to the motion base. 

It was shown that even the commanded input has wide motion discon- 
tinuity, which might lead to the conclusion that the Ormsby model 
has trouble handling this complex pulse train. Again the perceived 
velocity gradually increases to a maximum, at about ten seconds. 

Had the experiment been run past 19 seconds, the zero perceived 
velocity level would presumably be reached. While there is some 
room for argument that the nonlinear filter better presents the 
motion cues in this case, it is a tentative argument at best. 


Rudder Yaw Cues: 

As in the previous case of rudder roll cues, the motion history 
is a complicated pulse-like wave train. But unlike the roll cues, 
the yaw cues seem to be transferred to the motion base more reliably. 
This was also true of the aileron inputs. 

The motion histories for rudder yaw cues are similar for the 
first ten seconds. This is attributable to the slow rise in angular 
velocity perception seen previously. The ten second rise time agrees 
with the rudder roll cue case. The nonlinear filter again does a 
better job of containing the discontinuous motion than does the 
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the linear filter. The commanded case is smoother than the simulated 
case, but the nonlinear filter does not change the commanded motion 
very much in the transfer to the motion base. 


RESULTS 

The purpose of this investigation was to determine whether or 
not there is a vestibular explanation for the results obtained by 
Parrish and Martin. These results indicated that a nonlinear washout 
scheme provided better simulation fidelity than did the linear washout 
scheme.' This result was not due to the fact that the nonlinear filter 
presented more of the motion cue, rather, it eliminated the false 
rate cue which arises in the use of a linear filter. 

In order to accomplish the goal of providing a vestibular expla- 
nation for the anomalous. rate cue, the motion histories from the 
Parrish and Martin study were input to the Ormsby human dynamic orien- 
' tation model. Included were aileron and rudder motions with yaw and 
roll cues, for each of the two washouts. The output from the model 
is the. .perceived, angular velocity of .the..pilot during, simulation. 

The outputs for each of the motion histories were presented in 
the previous section. Several results can be pointed out:. 

The yaw cues provide the most compelling case 
for a vestibular explanation. In the 'aileron 
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yaw and the rudder yaw cases, the perceived 
angular velocities were “smoothed" considerably 
with the use of the nonlinear washout scheme 
as opposed to a linear washout scheme. The 
term “smooth" refers to the ability of the 
nonlinear filter to present a continuous 
motion closely resembling the commanded motion, 
rather than the discontinuous motion presented 
by the linear filter. The discontinuity which 
accompanies the use of the linear filter has 
previously been described as the fundamental 
difference between the two filters — the 
anomalous rate cue. This false cue manifests 
itself in the form of a- jump in the perceived 
angular velocity of the pilot. 

The results obtained for roll cue inputs were 
not so corroborative of the Parrish and Martin 
study as were the results for the yaw cue inputs. 
They did, however, show some of the characteristics 
exhibited in the yaw cue case. The nonlinear filter 
contained the discontinuous jumps induced by the 
pulse train to a greater extent than the linear 
filter. The nonlinear filter was better able to 
transfer the conmanded input to the motion base 
than the linear filter. 
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The explanation for the differences between the 
roll cues and the yaw cues most likely could be 
found in examining .the mechanical differences 
between motion in the two axes. Intuitively, 
it can be argued that the yaw motion simulation 
(twisting about earth vertical) is an easier 
task mechanically than roll motion simulation 
(twisting about the horizontal axis). No doubt 
a careful examination of the simulator base will 
reveal the cause of the differences observed. 

A comparison of the outputs for aileron and 
rudder inputs sheds some light on the usefulness 
of the Ormsby model. The aileron input consisted 
of two pulses, separated by 13 seconds, while the 
rudder input was a train of pulses. The Ormsby 
model has never been used with complicated input 
such as the rudder input. But despite the fact 
that the output contains large motion discontinuities, 
even for the commanded case, it is still possible to 
make a comparison between the linear and nonlinear 
schemes, and arrive at a conclusion similar to 
that reached in the aileron input case. Indeed, 
it does appear that the nonlinear filter contains 
the discontinuous perceived angular velocity more 
effectively than the linear filter. 

ORIGINAL PAGE IS 

OF POOR QUALITY 
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Thus it is seen that the Ormsby model provides a vestibular 
explanation for the subjectively acquired difference between the 
two washout schemes. The linear filter presents an anomalous rate 
cue as output from a pulse input, which the vestibular system trans- 
forms into a discontinuous perceived angular velocity. The nonlinear 
filter does not present this false cue, and the resulting vestibular 
transformation provides a much "smoother" perceived angular velocity. 
In addition, the comparison between the Ormsby model outputs from the 
aileron and rudder cue inputs gives insight into the model's use as 
a simulator design tool. 


CONCLUSIONS 

The work described here was carried out by Susan Reidel as 
part of her Master's thesis work. The detailed description of the 
experiments, programs and data are given in her thesis A Comparison 
of Washout Filters using a Human Dynamic Orientation Model . A copy 
of this thesis is attached. 



1 


A COMPARISON OF WASHOUT FILTERS 
USING A 

HUMAN DYNAMIC ORIENTATION MODEL 


by 


Susan A. Riedel 

B.S., Massachusetts Institute of Technology 

(1976) 

SUBMITTED IN PARTIAL FULFILLMENT 
OF THE REQUIREMENTS FOR THE' 

DEGREE OF MASTER OF SCIENCE 


at the 

MASSACHUSETTS INSTITUTE OF TECHNOLOGY 
September, 1977 



Accepted by 


Chairman, Departmental Graduate Committee 



2 


A COldPARISON OF WASHOUT FILTERS 
USING A 

HUMAN DYNAMIC ORIENTATION MODEL 

by 

Susan A. Riedel 


Submitted to the Department of Aeronautics and Astronautics 
on August 24, 1977, in partial fulfillment of the requirements 
for the degree of Master of Science. 

ABSTRACT 

The Ormsby model of human dynamic orientation, a discrete 
time computer program, has been used to provide a vestibular 
explanation for observed differences between two washout schemes. 
These washout schemes, a linear washout and a nonlinear wash- 
out, were subjectively evaluated by Parrish and Martin, They 
found that the linear washout presented false rate cues, caus- 
ing pilots to rate the simulation fidelity of the linear scheme 
much lower than the nonlinear scheme. By inputting the motion 
histories from the Parrish and Martin study into the Ormsby mo- 
del, it was shown that the linear filter causes discontinuities 
in the pilot’s perceived angular velocity, resulting in the sen- 
sation of an anomalous rate cue. This phenomenon does not oc- 
cur with the use of the nonlinear filter. 

In addition, the suitability of the Oamisby model as a sim- 
ulator design tool was investigated. It was found to be a use- 
ful tool in predicting behavior of simulator motion bases, even 
when the mechanical motion base is replaced by a computer sim- 
ulation, Further investigation of the model could provide sim- 
ulation designers with a tool to predict the behavior of motion 
bases still in the drawing board stage. 


ORIGINAL PAGE IS 
OP POOR QUAUTY 
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CHAPTER I 
INTRODUCTION 

For many applications it is often desirable to simulate 
a particular vehicle motion without using the actual vehicle: 

• The Federal - Highway Department sponsors many 
drunk driver studies. In order to insure the 
safety of the driver, the vehicle and the ex- 
perimenters, these experiments are often car- 
ried out in a moving base simulation of an 
automobile. 

« The U.S. Navy has commissioned studies of the 
habitability of large high-speed surface-eff- 
ect-ships. It is necessary to understand to 
what extent crews will be able to function on- 
these ships even before a prototype is built. 

This research is carried out on a motion gen- 
erator, which simulates the expected range of 
motion of these" ships [7] . 

• The. U.S. Air Force makes extensive use of both 
stationary- and moving base, aircraft simulators 
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in pilot training programs. Simulators pre- 
sent no risk to the pilot, and avoid the costs 
of fuel and repair or possible loss of an air- 
craft. 

The above examples illustrate three of the many possible 
uses of simulators - to carry out driver-vehicle studies with- 
out using an actual vehicle, to predict crew habitability on 
board a ship not yet built, and to train aircraft pilots with- 
out risking the pilot or the plane. As vehicles become in- 
creasingly complicated, and costs continue to rise, motion 
simulation takes on a new importance. 

There are many types of cues a person uses. to sense motion. 
The basic inputs are specific force and angular acceleration, 
which can influence the vestibular system in the inner ear, the 
tactile sensors at points of contact with the vehicle, and the 
proprioceptive sensors as muscles are ^stretched and compressed. 
In a simulator, it is not always possible to reproduce a par- 
ticular motion history exactly. Often, some cues can be pre- 
sented only at the expense of neglecting other cues. The basic 
goal in motion simulation is to arrive at a compromise in pre- 
senting the cues, in order to best represent the desired motion. 
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1«1 The Physiology of Motion Simulation 

Simulation technology now makes heavy use of digital 
computers to present as much of the motion cue as possible. 

High speed processing allows the use of very complex linear 
filters# and recently, of nonlinear adaptive filters. Micro- 
processor technology has also made much of the slower elec- 
trical circuitry obsolete. 

But the goa!l of simulation has not really changed - try 
to present as many of the specific force and angular acceler- 
ation cues as possible, without exceeding the constraints of 
the simulator [18] . This has always been the most .straight- 
forward approach, since it is the specific force and angular 
acceleration cues which are most readily available. 

Once a good understanding of the physiological aspects 
of motion simulation is attained, a physiological model of the 
human operator will be a valuable tool in simulator design. 

The comparison of actual motion and simulated motion using such 
a model would be useful in determining the realism of the sim- 
ulation in a’ quantitative way. This model would also be help- 
ful in comparing two different simulation schemes, providing 
a quantitative measure of their differences. 




17 


1»2 The Use of Washout and Visual Cues in Simulation 

Constraints in position, velocity and acceleration of a 
simulator limit the capability of producing a desired motion 
exactly. The problem is to present the sensations of a wide 
range of motion, and to do this in a very limited space. This 
problem is solved with the use of washout filters in each axis 
of motion, in order to attenuate the desired motion until it 
falls within the constraints of the simulator. 

An important aspect of motion simulation has not yet been 
mentioned - the visual cues available to detect motion. Peri- 
pheral visual cues seem to be most important in presenting the 
sensation of motion. The peripheral field may be stimulated 
by a moving pattern of stripes or dots, or by an actual "out - 
the - window" cockpit view [2,5], 

Taken together, washout filters and visual stimulation 
perform the function of simulation in which motions seem to go 
beyond the constraints of the simulator. The motion is dupli- 
cated to the point of constraint in a given axis. Then the wash- 
out filter takes over and attenuates the motion to meet the 
constraint. Meanwhile, the visual field is stimulated so as to 
give the impression of continued motion, motion beyond the cap- 
abilities of the simulator. In this way, a wide range of mo- 
tions can be simulated using a very restricted motion base. 
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1«3 Thesis Objectives and Organization ■ 

It is obvious from the previous discussion that the wash- 
out filters in a simulator are critical to the fidelity of the 
simulation. The research leading to this thesis compares two 
different types of washout filters currently in use, in order 
to quantify the differences between them.. The means of com- 
parison is a physiological model of human dynamic orientation, 
based largely on the known physiology, of the vestibular system. 
This work attempts to answer a specific question and a general 
question; 

• Can the observed differences in simulation 
fidelity between the two filters be explain- 
ed using a physiological model of h\iman dy- 
namic orientation? 

•What are the implications for this model as 
a drawing board tool in simulator design? 

Chapter II presents the two washout filters in detail, and 
discusses the previous work which led to the research present- 
ed in this thesis. 

Chapter III describes the human vestibular system and the 
model of hiiman dynamic orientation developed by Ormsby. 

Chapter TV describes the- data in this work, as input to 
the model, and then presents the perceived angular velocities ■ 
as output from the model. 
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Finally, Chapter V presents the conclusions which can be 
drawn from the results presented in Chapter IV, in light of 
the questions posed in the above- section. Also included are 
suggestions for further research in this area. 
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CHAPTER II 
THE WASHOUT FILTERS 


The two washout filters of interest in this coraparitive 
study are the following; 

• A linear filter, essentially a Schmidt and Conrad 
coordinated washout (16,17]. 

o A nonlinear filter, coordinated adaptive washout. 

Basically, the two filters are versions of Schmidt and Conrad’s 
coordinated washout. This scheme uses washout filters in the 
three translational axes, and only indirectly washes out the 
angular motion. The primary difference between the linear and 
nonlinear schemes is in the type of translational washout fil- 
ters employed. The linear scheme uses second-order classical ‘ 
washout filters in the three axes, while the nonlinear scheme 
uses coordinated adaptive filters for longitudinal and lateral 
washout and digital controllers for vertical washout. These 
schemes differ in their presentation of the rate cues, for a 
pulse input. The linear scheme presents an anomalous rate cue 
when the pulse returns to zero. This behavior is not observed 
with the nonlinear scheme. 
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The next two sections .discuss the filters in greater de- 
tail. The final sections present the differences between the 
filters and the results of a previous subjective analysis of 
the washout schemes, 

2,1 The Linear Washout 

The purpose of washout circuitry is to present transla- 
tional accelerations and rotational rates of the simulated air- 
craft, It is necessary to obtain coordination between trans- 
lational and rotational cues in order to accomplish certain 
motion simulations: 

« A sustained horizontal translational cue can 
be represented by tilting the pilot. The 
gravity vector is then used to present the 
cue. But in order to make this process be- 
lievable# the rotation necessary to obtain^ 
the tilt angle must be below the pilot’s ab- 
ility to perceive rotation. The solution is 
to start the cue with actual translational 
motion of the simulator until the necessary 
tilt angle is obtained. In this manner, the 
pilot will sense only translational motion, 
long after such motion has actually ceased. 

• In a similar sense, it can be seen that a de- 
sired roll or pitch cue cannot be represented 


22 


by means of rotation alone. This would result 
in a false translational cue, because the gra- 
vity vector is misaligned. In order to present 
a rotational cue, translational motion must be 
used at the start, to offset the false trans- 
lational motion cue induced by the rotation. 

The two cases above clearly illustrate the need for coor- 
dination in translational and rotational motion. Schmidt and 
Conrad’s coordinated washout scheme fulfills this need. Fig- 
ure 2.1 presents a block diagram illustrating the basic con- 
cepts , 

The desired motions of the simulated aircraft are trans- 
formed from the center of gravity of the aircraft to the cen- 
troid of the motion base. This transformation provides the de- 
sired motion at the pilot's seat. The motions of the base are 
based on the desired motions of the centroid. 

Vertical specific force is transformed to vertical accel- 
eration by use of a second-order classical washout filter. 

The longitudinal and lateral accelerations are also obtained 

{ 

from the longitudinal and lateral specific forces. First, these 
specific forces are separated into steady-state and transient 
parts. The steady-state part of the cue is obtained from a 
tilt angle to align the gravity vector. The transient part of 
the cue is transformed into the longitudinal acceleration, x^, 
and the lateral acceleration, y^, by a second-order classical 
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Figure 2,1 Block diagram for Schmidt and Conrad v/ashout 


scheme [17] 
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washout filter. 

Braking acceleration is then used to keep the motion with- 
in the prescribed position# velocity and acceleration limits 
of the motion base. 

The rotational degrees of freedom are only indirectly 
washed out through elimination of false g cues. Rotational 
rate cues are represented by angular and translational motion, 
just a!s longitudinal or lateral cues. But in this case, the 
translational motion is used only to eliminate the false g cue 
induced by rotational movement, and thereby makes no direct 
contribution to the rotational cue. 

After the six position commands (x^,y^,z^,T{) ,9 ,<f) are ob- 
tained from the washout circuitry, lead compensation is pro- 
vided to compensate for servo lag of the base. The actuator 

V 

extension transformation is then used to obtain the correct 
actuator lengths used to drive the motion base. 

The actual filter evaluated in this wbrk is. a Schmidt:' and 

> 

Conrad coordinated washout, adapted by Langley Research Center 
[14], The major difference is that the Langley washout is car- 
ried out in the inertial reference frame, rather than the body 
axis system. A block diagram of this filter is shown in Fig- 


ure 2.2 
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Figure 2.2 Block diagram for Langley linear washout scheme [13] 
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2,2 The Nonlinear Washout 

The nonlinear filter of interest . here is again essentially 
a Schmidt and Conrad coordinated washout. The difference be- 
tween the nonlinear Langley filter cind the Schmidt and Conrad 
filter are that the Langley filter uses the inertial reference 
frame rather than the body axis system, and nonlinear filters 
are used for the washout rather than the linear filters used 
by Schmidt and Conrad. Hence, the designation "nonlinear wash- 
out" is used. 

Figure 2.3 presents a block diagram for this nonlinear 
scheme. It is seen that two different types of nonlinear fil- 
ters are used - coordinated adaptive filters for longitudinal 
and lateral cues, and digital controllers for-vertical cues. 
These two types of filters will- be discussed in* turn, 

'f 

• ' / 

Coordinated adaptive filters [11] are based on the prin- 
ciple of continuous steepest descent. They are used in this 
washout scheme to coordinate surge and pitch in presenting the 
longitudinal cues, and sway and roll in presenting the later- 
al cues. Derivation of these filters can be found in the liter' 
ature [11,12], Basically, they perform the same functions as 
the second-order classical filters used by Schmidt and Conrad 
by providing translational specific force cues and rotational 
rate cues. 

Digital controllers-, the second type of nonlinear filters, 
are used to provide the uncoordinated heave and yaw cues, A 
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first-order digital controller provides the yaw rate cue, while 
a second-order controller provides the vertical specific force 
cue. These filters are designed to present as much of the on- 
set cue as possible before switching to the washout logic. 

Figure 2.4 illustrates the design concept for a first- 
order digital controller. From 0 to the controller presents 
a scaled version of the commanded input. At a linear decay 
is applied to reduce the command to the motion base constraint 
value, B. Washout then occurs at the constrained value, unless 
another input is commanded, as at 

The second-order digital controller used for the vertical 
specific force is similar, although mathematically more 
complex. 


2.3 A Comparison of Washout Schemes 

Essentially, the two washout schemes of interest are 
Schmidt and Conrad washouts. The so-called linear washout 
contains second-order classical washout filters which trans- 
form the specific forces in each axis to translational accel- 
erations in each axis. The Langley washout performs these 
transformations in the inertial frame rather than the body 
axis frame used by Schmidt and Conrad. 

The nonlinear washout scheme uses two types of nonlinear 
filters to provide the translational acceleration cues, A 
coordinated adaptive filter is used to coordinate surge and 
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pitch for longitudinal cues, and sway and roll for lateral 
cues. A digital controller is used for the uncoordinated 
heave and yaw motions* Again, the Langley nonlinear scheme 
washes out in the inertial frame* 

In Figure 2.5, amplitude and phase versus frequency is 
shown for the three types of washout filters - linear, adaptive 
and digital controller. Both the first-order and second-order 
cases are shown. The motion base characteristics are the same 
in all cases. Since the amplitude and phase response of the 
nonlinear adaptive filter changes with the magnitude of the in- 
put, the worst case for the nonlinear filter is presented here. 
As is shown, the digital controller has the best response char- 
acteristics, and the adaptive filter is better than the linear 
filter. This holds true for both the first- and second-order 
cases. 

In terms of motion cues, there is a fundamental difference 
between the linear filter and nonlinear filter for the first- 
order case. Figure 2,6 shows the response of the two filters 
to a pulse input. The difference between the filters is the 
anomalous rate cue presented by the linear filter as the pulse 
input returns to zero* This false cue is most noticeable for 
pulse-type inputs, and disappears as the input becomes sinu- 
soidal, Since the differences between the linear and nonlinear 
filters vary with input, performance of a given filter is depen- 
dent on pilot input and simulator responsiveness in each axis* 
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2 »4 Empirical Comparison of Washout Filters 

Parrish and Martin, the major investigators of these two 
washout schemes at Langley, devised a subjective test to deter- 
mine the differences between the two filters in actual simula- 
tion 113] . Seven pilots flew a six-degree-of-freedom simulator 
equipped with both linear and nonlinear washout schemes, . The 
pilots were asked to rate the motion cues presented by each 
scheme for throttle, column, wheel and pedal inputs about a 
straight-and-level condition during a landing approach* 

The results of this evaluation process are presented in 
Table 2.1. Each pilot determined his own criteria for evalua- 
tion, In addition to rating the cues for each input, the pilots 
were asked to rate the overall airplane feel - that is, how 
successful the overall motion was in representing the actual 
airplane. In the table, the open symbols represent the rating 
of the linear method, while the solid symbols represent the 
rating of the nonlinear method. The washout methods were ap- 
plied to a 737 CTOL aircraft simulation, and four of the pilots 
(represented by the triangular symbols) had previous 737 cock- 
pit experience. 

The pilot ratings for the throttle input are the same for 
each method, as shown in Table 2,1, Even given the methods 
back to back for comparison, the pilots could not detect that 
a change had been made. Figure 2,7 shows the time histories 
for such a change in throttle setting. Longitudinal accelera- 
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tion and pitch rate are the inputs to the washouts from the 
simulated aircraft for such a maneuver. The figure shows very 
little difference between the washout schemes, as the pilot 
ratings indicated. The fundamental difference between the two 
pitch rate filters is obscured in order to correctly represent 
the decrease in longitudinal acceleration at six seconds. 

An elevator doublet was input to rate the motion cues for 
a column input. Again, the pilots found little difference be- 
tween the linear and nonlinear washout schemes, as shown in 
Table 2.1. Four pilots rated the filters the same, while the 
other three rated the nonlinear filter slightly higher. The 
time histories for the elevator inputs are shown in Figure 2,8. 
As in the throttle input case, the fundamental difference be- 
tween the pitch rate filters is not apparent, due to the coor- 
dination between pitch rate and longitudinal acceleration. In 
addition, the pitch response of the 737 is not at all pulse- 
like, which lessens the difference in performance of the filters 

Wheel inputs were evaluated using ailerons to bank the 
simulator 20° for a 30° heading change with a return to straight 
and-level flight. The pilots preferred to separate the wheel 
inputs into roll cues and yaw cues to evaluate these cues in- 
dividually, Figure 2,9 shows the time histories for roll cues 
in the maneuver described.' The anomalous rate cue is present 
for the linear washout. This is reflected in the pilots* rat- 
ing, as seen in Table 2,1. All seven pilots felt the nonlinear 
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filter to be at least one and one~half categories higher than 
the linear filter. 

Figure 2.10 shows the time histories for yaw cues during 
the same aileron maneuver. Again, the anomalous rate cue is 
present for the linear filter scheme. The pilots were parti- 
cularly aware of a negative rate cue when the simulated air- 
craft rate returned to zero during maneuvers of this type. 

The ratings in Table 2.1 are at least one category higher for 
the nonlinear scheme, reflecting the unnateral feel of the 
linear rate cue. 

Each pilot flew a set of rudder maneuvers for both wash- 
outs to evaluate roll and yaw cues. There were no changes in 
the ratings from those obtained using the wheel. This is re- 
flected in the time histories for roll and yaw, shown in Fig- 
ures 2.11 and 2.12, respectively. 

Finally, each pilot was asked to rate the two washout 
schemes in terms of overall airplane feel. Table 2.1 shows 
the large contribution made by roll representationin the . over- 
all airplane simulation. All pilots rated the nonlinear wash- 
out at least one and one-half .categories higher than the lin- 
ear washout. They specifically objected to the anomalous rate 
cue presented by the linear filter in both roll and yaw. 

From this study, Parrish and Martin concluded that the non- 
linear washout scheme better represents actual airplane motions 
than does the linear washout method, at least in an empirical 
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sense. It appears that the nonlinear scheme does not present 
more of the motion cue; it merely eliminates the false cue pre- 
sent in the use of the linear washout. 

The work presented in this paper attempts to quantify the 
results obtained in the subjective analysis made by Parrish 
and Martin. In order to accomplish this, the motion histories 
from the Parrish and Martin study are input to a model of human 
dynamic orientation. The output from the model will provide 
a vestibular explanation for the sensation differences between 
the two filters. Results of this work are presented in Chap- 
ter IV. 
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CHAPTER III 

THE PHYSIOLOGICAL MODEL 

A model which predicts human perceptual response to mo- 
tion stimuli has been developed at M,I.T.*s Man-Vehicle Labor- 
atory by Orrasby [10] . The model, which exists as a FORTRAN com- 
puter program, is based on the known physiology of the vesti- 
bular system* While little is known about the processing of- 
the specific forces and angular accelerations received from the 
vestibular organs, the simplifying assumptions made about this 
process produce a model which agrees with available neurologi- 
cal and physiological data. 

This chapter first presents an overview of the vestibular 
system, and then goes on to discuss the mathematical modelling 
of the system which leads to the current FORTRAN model. More 
detailed descriptions of the vestibular sys-tem may be found in 
the literature [9,15,19,20], The complete derivation of the 
model of human dynamic orientation is found in Ormsby, And a 
description of the actual FORTRAN programs and their use is 
available in the appendix to this thesis. 
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3,1 The Hiaman Vestibular System 

The vestibular system, or labyrinth, comprises the non- 
auditory portion of the inner ear. It is composed of three 
semicircular canals, one utricle and one saccule in each ear. 

The semicircular canals are the rotational motion sensors. 

They consist of three approximately orthogonal circular tor- 
oidal canals. The canals are filled with a water-like fluid 
called endo lymph. When the head tmdergoes angular accelera- 
tion, the endolymph tends to lag behind the motion of the canal 
walls. The motion of the endolymph relative to the canal walls 
displaces the cupula, a gelatinous mass which completely ob- 
structs one section of the canal called the ampulla. Sensory 
hair cells embedded at the base of the cupula detect its dis- 
placement. As a result, the deformation of the cupula is trans- 
formed into an afferent firing rate which provides a signal of 
rotational motion to the central nervous system {see Figure 
3,1) . 

In a particular canal, all of the hair cells have the same 
polarization. When the flow of endolymph displaces the cupula 
in a single direction, the hair cells are either all excited 
or all inhibited. As shown in Figure 3,2, the canals on either 
side are essentially coplanar with the other side. Thus, they 
are pairwise sensitive to angular accelerations about the same 
axis. Since a pair of canals which are sensitive about the 
same axis have opposite polarities, it is assumed that the high- 
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Figure 3,1 Horizontal semicircular canal [10] 
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Figure 3,2 Orientation of semicircular canals [10] 
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er processing centers respond to the difference in afferent 
firing rates. 

Two otolith organs consisting of a utricle and a saccule, 

are located in each ear. The otolith is sensitive to changes 

/ 

in specific force. Figure 3.3 depicts the basic structure of 
the otolith organs. The otolith consists of a gelatinous 
layer containing calcium carbonate crystals, known as otoconia. 
This layer is supported by a bed of sensory hair cells. An 
acceleration of the head shifts the otoconia relative to the 
surrounding endolymph, due to the higher specific gravity of 
the otoconia. This shifting causes the sensory hair cells to 
bend, sending a change in afferent firing rate through the af- 
ferent nerve fibers to the central nervous system. 

As shown in Figure 3.4, the utricles are oriented such 
that their sensitivity is in a plane parallel to the plane of 
the horizontal semicircular canals* The sensitivity of the 
saccules is in a plane perpendicular to the horizontal canals. 
The hair cells in the utricle are sensitive in all directions 
parallel to its plane of orientation, while the hair cells in 
the saccule make it predominantly sensitive to accelerations 
perpendicular to the utricular plane* 
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Figure 3.3 Cross sectioii of ofollfh [10] 
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3,2 The Ormsby Model 

The mathematical model of the semicircular canals consists 
of several parts. The first' part is the mechanical model of 
the cupula deflection caused by motion of the endolymph. The 
second part includes the interaction between the mechanical 
movement and the afferent firing rate. The third part concerns 
measurement noise, which is that portion of the afferent sig- 
nal found to be independent of the mechanical stimulus input. 

Figure 3,5 depicts the afferent model of the semicircular 
canals as arrived at by Ormsby, Observation of cupula motion 
led to the torsion pendulum model [9]^ suggesting that the over- 
damped system reacts to angular velocity rather than angular 
acceleration. The results of the model are expressed as a 
transfer function of the following form; 

FR (s) = (57,3) (300s^) (,01s+l) 

c oi(s) 

(18S+1) (,005s+l) (30s+l) 

+ + n(t) (3.1) 

s 

The model of the otolith system is composed of two parts 
- the mechanical model of the otolith sensor, and the affer- 
ent response to otolith displacement. Figure 3,6 presents the 
afferent model of the otolith system used by Ormsby, The me- 
chanical model of the otolith is that of a fluid-immersed mass 
retained by a spring. The resulting transfer function relat- 
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ing afferent firing rate to specific force- is: 

FR (s) = (18000) (s+.l) 

o SP(s) + SFR + n(t) (3.2) 

(s+,2) (s+200) ® 

The input to the model consists of a stimulus composed of 
specific forces and angular accelerations in each axis of the 
head coordinate system. Each of these afferent inputs is then 
transformed into sensor coordinates. From this sensor stimula- 
tion, the afferent firing rates are derived, using the trans- 
fer functions presented above. 

At this point, the process becomes purely guesswork. Even 
assuming that these afferent firing rates are available to some 
central processing system in the brain, the form which this 
processing takes is simply a guess. Ormsby guessed that the 
central processor performs a type of least mean squares error 
optimization to make an estimate of the specific force and 
angular velocity inputs based on the afferent firing rates out- 
put from the vestibular system sensors. 

In this case, such a least mean squares estimator is a 
Kalman filter [4,8]. The input is unknown except for an ex- 
pected range of magnitude and a frequency bandwidth, and an ex- 
pected measurement noise. Also, the input and the noise stat- 
istics are time invariant, which makes the filter a steady- 
state Kalman (or Wiener) filter. This steady-state Kalman fil- 
ter is used by the model to produce estimates of specific force 
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and angular velocity from the afferent firing rates. These 
estimates are tuned, using the Kalman filter gains, to yield 
estimates which fit the available neurological and physiologi- 
cal data for known inputs. 

The filters used for canal processing are tuned such that 
the estimates produced for the angular velocities are essential- 
ly unchanged from the afferent inputs. This observation is in 
agreement with available data, suggesting that veiry little 
central processing is performed. The otolith filters must be 
tuned so that a more dramatic effect by the filters on the aff- 
erent input is observed. This suggests that more central 
processing is required, or. that the model of the afferent re- 
sponse is missing a term which has subsequently been attribut- 
ed to the central processing mechanism in the tuning procedure. 
Basically, the filter acts as a low pass filter with a time 
constant of 0,7 seconds. The utricle and saccule differ only 
in the Kalman filter gains, where the saccule gains are twice 
the utricle gains. 

Once the specific force and angular velocity estimates 
have been obtained from the Kalman filters, the saccule non- 
linearity must be accounted for. This is done by means of a 
nonlinear input-output function, and allows the model to in- 
clude observed attitude perception inaccuracies known as Au- 
bert or Mueller effects [6] , The resulting specific force and 
angular velocity estimates are transformed back to head coor- 
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dinates . 

These estimates must now be combined to yield new estimates 

V 

of perceived position, velocity and acceleration. In the model 
this is accomplished by a separate scheme, known as DOWN . DOWN 
is a vector of length 1 g in the direction of perceived ver- 
tical; as such, it is the model's prediction of the perceiv- 
ed vertical. The basic assumptions used in combining the spe- 
cific force and angular velocity estimates to arrive at DOWN 
are the following: 

• • The system will rely on the low frequency por- 
tion of the specific force estimates provided 
by the otoliths . ' 

• The system will use that part of the canal in- 
formation which is in agreement with the high 
frequency content of the rotational informa- 
tion provided by the otoliths. 

This logic is presented in Figure 3.7. Block A produces 
the estimate of rotational rate from the input specific forces 
assuming ^ is fixed in space. The low frequency component of 
this estimate is filtered out in Block B. Block C isolates 
the component of the low frequency angular velocity estimate 
which is perpendicular to ^ and DOWN . This is the mechanism 
discussed in Chapter II, which allows cancellation of canal 
signals arising when prolonged rotations are stopped sudden- 
ly. The effect of the three blocks is to produce a rotational 
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Figure 3.7 DOWN estimator [xo) 
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vector which represents the low frequency rotational informa- 
tion available from the otoliths. (R . ) . 

oto 

Block D confirms whether or not the high frequency portion 
of the canal rotational information is consistent with the high 
frequency portion of the otolith rotational information. The 
inconsistent part of the canal information is sent through a 
high pass filter (Block E) and is then combined with the con- . 
sis tent portion of the canal information. The component of 
the resulting rotation vector parallel to DOWN is then elimi- 
nated, leaving a rotational vector due to canal information 

(R ) ^ The total estimate of the rotation rate of the outside 
ssc 

world with respect to the last estimate of DO^»?N , com- 

puted by subtracting R from R_+... The net result of Blocks 
H and I is to produce an estimate of DOWN which is the same as 
the estimated specific force vector. This is accomplished by 
a slow reduction in the discrepancy between ^ and DOWN , elim- 
inating any accumulated errors resulting from the integration 
of rate information. 

Figure 3 . 8 illustrates the model for predicting perceived 
rotational rate. The angular velocity vector parallel to DOVJN 
becomes the perceived parallel - angular velocity. The perpen- 
dicular angular velocity is computed in three steps; 

1, Calculate the difference between the com- 
ponent of angular velocity perpendicular 
to DOV^, and the angular velocity cons is- 
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tent with the rate of change of the direc~ 
tion of DOV?N (Block K) . 

2. High pass filter this difference. 

3, Combine the filtered result with the DOWN- 
consistent angular velocity. 

This process assures that the canals provide the high frequency 
' component of the rotational rate^ while the low frequency com- 
ponent is the rotational rate consistent with DOWN . The total 
sense of rotation is thus the sum of the parallel and perpen- 
dicular components. 

This completes the description of the form of the Ormsby 
model used in this work. A complete description of the model 
may be found in Oirmsby’s thesis. Figure 3.9 presents an over- 
view of the entire model. At this point, a few important ob- 
servations should be made: 

• The Ormsby model was tuned using inputs with 
known outputs for a certain set of discrete 
time intervals - namely, an afferent update 
interval of 0.1 seconds and a Kalman filter 
.estimate update interval of 1,0 seconds. In 
this thesis, due to the characteristics of the 
input data, the afferent update interval is 
0,03125 seconds, and the Kalman filter esti- 
mate update interval is 0,25 seconds. In order 
to use these two intervals, the model had to 
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be retuned by changing the Kalman gains. This 
process# which is necessary each time the update 
intervals are changed, is described in more de- 
tail in the appendix. 

• One important assumption made by this model is 
that the inputs are unknown prior to their pro- 
cessing, It was noted in the introduction to 
this thesis, that specific force and angular ac- 
celeration act on the body as a whole, provid- 
ing visual, tactile and proprioceptive, as well 
as vestibular, cues. This model takes accdunt 
of the vestibular cues only, although the tun- 
ing process may force it to consider certain 
aspects of the other sensory cues. Thus, when 
this model is applied to cases where the sxib- 
ject might have prior knowledge, or at least 
an expectation of the motion, the results must 
be interpreted in light of the limitations im- 
posed by the model. 

The Ormsby model of human dynamic orientation was used in 
this work as a FORTRAN program implemented on a PDP 11/34, 

The main program, as well as all associated subroutines, is 
documented in the appendix. 
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CHAPTER IV 
DATA AND RESULTS 

As a logical consequence of the two previous chapters, it 
is desirable now to evaluate the two washout schemes using the 
Ormsby model of human dynamic orientation. Such an evaluation 
could serve the purpose of quantifying the differences between 
the two filters which Parrish and Martin found in their subjec- 
tive study. In addition, this evaluation could shed some light 
on the question of the model’s usefulness in simulator design. 

This chapter presents the data used for this study, and 
the results of the processing of the data by the Ormsby model, 

4,1 Data Description 

•The data used in this work consists of four runs made 
with a linear or a nonlinear washout on the Langley simulator. 
These runs coincide with Figures 2,9, 2,10, 2.11, and 2,12, 
Table 4,1 lists the definitions of the variables measured dur- 
ing these simulation runs, • Note that not only are the simula- 
tor motions recorded, but also the commanded motions of the 
aircraft. This allows evaluation of both the computer Simula- 
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Table 4,1 Variables recorded during simulation runs 


VARIABLE DEFINITION 


TIME 

DELA 

DELE 

DELR 

THRIL 

PA 

PADOT 

QA 

QADOT 

RA 

RADOT 

AXA 

AYA 

PSIA 

THEA 

PHIA 

P 

Q 

R 

PDOTM 

QDOTM 

RDOTM 

AXCM 

AYCM 

PSIMB 

THEMB 

PHIMB 

XDDMB 

YDDMB 


time 

aileron deflection 
elevator deflection 
rudder deflection 
throttle input 
roll rate of airplane 
roll acceleration of airplane 
pitch rate of airplane 
pitch acceleration of airplane 
yaw rate of airplane 
yaw acceleration of airplane 
longitudinal acceleration of airplane 
lateral acceleration of airplane 
t|» of airplane 
8 of airplane 
^ of airplane 

roll rate command to simulator 
pitch rate command to simulator 
yaw rate command to simulator 
roll acceleration measured on simulator 
pitch acceleration measured on simulator 
yaw acceleration measured on simulator 
longitudinal acceleration measured on simulator 
lateral acceleration measured on simulator 
^ of simulator 
8 of simulator 
of simulator 

longitudinal acceleration of simulator without 
gravity component 

lateral acceleration of simulator without grav- 
ity component 



65 


tion of the motion and the actual simulator motion. This data 
was recorded at Langley on' their CDC 6600 computer. 

Figure 4.1 presents the aileron and rudder inputs to the 
simulation schemes, as previously shown in Chapter II. Table 
4,2 illustrates the four separate runs, and the data taken 
from each for use in the Ormsby model. Thus, there are twelve 
separate cases under evaluation. Both the rudder and the ailer- 
on inputs are simulated using the linear and nonlinear filters. 
For each of these four cases there are two simulated motion 
histories and one commanded motion histoiry. 

The input to the Ormsby model is a subroutine known as 
STIM. The input to STIM is the time in seconds into the mo- 
tion history. This is computed in the main program. The out- 
put from STIM consists of three vectors - a specific force 
vector in g’s, a unit vector in the direction of gravity in 
g's, and an angular velocity vector in radians/second. The 
particular STIM subroutine used for this work can be found in 
the appendix. Basically, it reads the data from, a file on 
disk in consecutive time order and places - the desired data in 
the correct vector location. For example, when running the 
linear aileron roll data, the twentieth data item in the twen- 
ty-nine item list (see Table 4,1) is read into the first loca- 
tion of the angular velocity vector, after transforming it 
from an acceleration in degrees/second^ to a velocity in radi- 
ans/second. Thus, the STIM subroutine must be changed each 
time the model is run, to accomodate the new data. 
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INPUT \ 

ROLL 

YAW 

AILERON 

1 

•Linear 

Simulator 

(PDOTM) 

Nonlinear 

Simulator 

(PDOTM) 

Linear 

Simulator 

(RDOTM) 

Nonlinear 

Simulator 

(RDOTM) 

Command 

(PADOT) 

Command 

(RADOT) 

. 

RUDDER . 

Linear 

Simulator 

(PDOTM) 

Nonlinear 

Simulator 

(PDOTM) 


Nonlinear 

Simulator 

(RDOTM) 

■ 

> 

Command 

(PADOT) 

Command 

(RADOT) 


S^ulator *“ recorded motions of the moving 
base simulator 

Command ~ requested motions of the moving 
base simulator made by the sim- 
ulation routine 


Table 4,2 Data used as input to Ormsby model 
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The following four sections present the output of the 
model for the four major categories - aileron roll cues, ai- 
leron yaw cues, rudder roll cues and anidder yaw cues, 

4,2 Aileron Roll Cues 

Figures 4,2, 4,3 and 4,4 present the time histories of 
perceived angular velocity in response to aileron roll cues, 
using the linear and nonlinear washout schemes. In addition, 
the response to the commanded aileron roll is also shown. In 
each case, the perceived motion is approximately the same for 
the first thirteen seconds. The angular velocity rises grad- 
ually to a peak of ,06 radians/second (3.5 degrees/second). 

This is consistent with the expected response to the 5°/second 
input roll velocity of the pulse-type aileron cue. It is after 
this peak perceived velocity is reached that the interesting 
differences occur. 

But it is just at thirteen seconds when the second pulse 
is input. The linear and nonlinear washouts cause the perceiv- 
ed velocity to change direction, as indicated by the sign change. 
In the linear case, this change in direction does not occur un- 
til the end of the run, while in the nonlinear case it occurs 
at fifteen seconds. In both cases there is apparent confusion 
of direction. Just as there was in the first pulse, there 
should be a delay before the perceived angular velocity begins 
to return to zero. The experiment actually ends too soon, so 
the zero level is never reached. 
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linear aileron, roll cue input 
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A real difference can be seen in comparing the simulated 
cases with the commanded case. As can be seen in Figure 4.4, 
the commanded case behaves as predicted - there is a gradual 
increase to the maximum perceived angular velocity, and then a 
leveling off. Presumably, if the experiment had beeii carried 
past the second pulse, there would be a gradual return to zero 
in angular velocity 

In this case, then, the nonlinear filter acts to contain 
the confused perception involved in transferring the second 
pulse to the motion base. While it performs better than the 
linear filter, it presents motion cues which are not quite able 
to duplicate the desired motion perception. 
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4.3 Aileron Yaw Cues 

Figures 4.5, 4,6 and 4.7 present the perceived angular 
velocities output from the Ormsby model, for inputs of yaw 
cues for aileron motions. In' this case, the difference between 
the linear and the nonlinear washouts is evident. Again, the 
first thirteen seconds for each case are about the same - the 
expected response to a pulse input is the slow rise to a max- 
imum angular velocity, then a leveling off. This is the same 
response observed for the roll cues, as seen in Figures 4,2, 

4.3 and 4.-4. 

Thirteen seconds into the motion history, the second 
pulse is introduced. In the case of the roll cues, the 
motion transferred to the simulator was rather rough. But for 
the yaw cues, the simulation was very close to the desired mo- 
tion, This can also be seen by comparing Figure 2.9 with Figure 
2,10 - notice how smooth the nonlinear response is in Figure 
2,10 compared to the. linear response in Figure 2,9. 

As before, the commanded motion to the simulator is smooth 
and presents the expected response. A comparison of Figures 
4,5 and 4,6 shows that the nonlinear filter presented the sec- 
ond pulse with very little disturbance, wjiile the linear filter 
caused a noticeable discontinuity in the motion. This is the 
anomalous rate cue which the pilots reported on in Table 2.1, 


OF POOR 



OUTPUT 

rad/sec 


5 


10 

TIME sec 


15 


2 


r.Ol ■ 
-.02 ' 
-.03 - 
-.04 ' 
-.05' 
-.06 ' 


Figure 4.5 Perceived angular velocity for simulated 
linear aileron yaw cue input 
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nonlinear aileron yaw cue input 
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4.4 Rudder Roll Cues 

Figures 4.8, 4,9 and 4,10 present the perceived angular 
velocities obtained from the rudder roll cue inputs. The sit- 
uation here is different from the previous aileron cases, sim- 
ply because the motion history in the rudder cue cases is much 
more complicated than in the aileron cue cases (see Figure 4,1) . 
It is not clear that the Ormsby model is equipped to handle 
such a rapidly vairying motion history, and this must be kept 
in mind during an analysis. 

It does appear, however, that even in this more complex 
case, the nonlinear filter is able to contain the confused per- 
ceptions associated with transferring the pulse train to the 
motion base. Figure 4,10 shows that even the commanded input 
has wide motion discontinuity, which might lead to the conclu- 
sion that the Ormsby model has trotible handling this complex 
pulse train. Again, the perceived velocity gradually increases 
to a maximum, at about ten seconds. Had the experiment been 
continued past nineteen seconds, the zero perceived velocity 
level would presumably gradually be reached'. While there is 
some room for argument that the nonlinear filter better presents 
the motion cues in this case, it is a tenative argviment at best. 
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4,5 Rudder Yaw Cues 

Figures 4.11, 4,12 and 4,13 present the final case - the 
perceived velocities obtained from rudder yaw cues. As in the 
previous case of rudder roll cues, the motion history is a com- 
plicated pulse-like train. But unlike the roll cues, the yaw 
cues seem to be transferred to the motion base more reliably. 
This was also true in the case of aileron inputs. 

The motion histories for rudder yaw cues are similar for 
the first ten seconds. This is attributed to the slow rise in 
angular velocity perception seen previously. The ten second 
rise time agrees with the rudder roll cue case. The nonlinear 
filter again does a better job of containing the discontinuous 
motion than does the linear filter. The commanded case is 
smoother than the simulated case, but the nonlinear filter 
does not change the commanded motion very much in the transfer 


to the motion base 
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4 « 6 Results 

The purpose of this investigation was to determine wheth- 
er or not there is a vestibular explanation for the results ob- 
tained by Parrish and Martin. These results (reported on in 
Chapter II) indicated that a nonlinear washout scheme provided 
better simulation fidelity than did the linear washout scheme. 
This result was not due to the fact that the nonlinear filter 
presented more of the motion cue; rather, it eliminated the 
false rate cue which arises in the use of the linear filter. 

In order to accomplish the goal of providing a vestibular 
explanation for the anomalous rate cue, the motion histories 
from the Parrish and Martin study were input to the Orrasby hu- 
man dynamic orientation model. Included were aileron and rud- 
der motions with yaw and roll cues, for each of the two wash- 
outs. The output from the model is the perceived angular vel- 
ocity of the pilot during the simulation. 

The outputs for each of the motion, -histories were present- 
ed in the preceding sections. Several results can be pointed 
out: 

•The yaw cues provide the most compelling case 
for a vestibular explanation. In the aileron 
yaw and the rudder yaw cases, the perceived 
angular velocities were "smoothed" considerably 
with the use of a nonlinear washout scheme as 

s 

opposed to a linear washout scheme. The term 
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"smooth? refers to the ability of the nonlin- 
ear filter to present a continuous motion clo- 
sely resembling the commanded motion, rather 
than the<discontinuous motion presented by the 
linear filter. The discontinuity which accom- 
panies the use of the linear filter has previ- 
ously been described as the fundamental differ- 
ence between the two filters - the anomalous 
rate cue. This false cue manifests itself in 
the form of a jump in the perceived angular 
velocity of the pilot, 

• The results obtained for roll cue inputs were 
not so corroborative of the Parrish and Martin 
study as were the results for yaw cue inputs. 
They did, however, show some of the character- 
istics exhibited in the yaw cue case. The non- 
linear filter contained the discontinuous jumps 
induced by the pulse train to a greater extent 
than the linear filter. The nonlinear filter 
was better able to transfer the commanded input 
to the motion base than the linear filter. 

This is evident in comparing Figures 4,11, 4.12 
and 4.13. 

• The explanation for the differences between the 
roll cues and the yaw cues most likely could be 



87 


found in examining the mechanical differences 
between motion in the two axes. Intuitively, 
it can be argued that the yaw motion simulation 
(twisting about earth vertical) is an easier 
task mechanically than roll motion simulation 
(twisting about the horizontal axis) . No doubt 
a careful examination of the simulator base 
will reveal the cause of the differences obser- 
ved, 

• A comparison between the outputs for aileron 
and irudder inputs sheds some ' light on the use- 
fulness of the Oimisby model. The aileron in- 
put consisted of two pulses, separated by thir- • 
teen seconds, while the rudder input was a 
train of pulses. The Ormsby model has never 
been used with a complicated input such as the 
irudder input. But despite the fact that the 
output contains large motion discontinuities, 
even for the commanded case, it is still pos- 
sible to make a comparison between the linear 
and nonlinear schemes, and arrive at a conclu- 
sion similar to that reached in the aileron in- 
put case. Indeed, it does appear that the non- 
linear filter contains the discontinuous per- 
ceived angular velocity more effectively than 
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the linear filter. 

Thus it is seen that the Ormsby model provides a vestibu- 
lar explanation for the subjectively acquired difference between 
the two washout schemes. The linear filter presents an anoma- 
lous rate cue as output from a pulse input, which the vestibu- 
lar system transforms into a discontinuous perceived angular 
velocity. The nonlinear filter does not present this false cue, 
and the resulting vestibular transformation provides a much 
“smoother" perceived angular velocity. In addition, the com- 
parison between the Ormsby model outputs from aileron and rud- 
der cue inputs gives insight to the model’s use as a simulator 
design tool. 
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CHAPTER V 
CONCLUSIONS 

This thesis began with a discussion of the importance of 
motion simulation in general, and went on to examine a parti- 
cular aspect of simulation - the washout filters used to con- 
strain the motion of the simulator and maintain the fidelity 
of the simulation. The two washout schemes examined here were 
a linear washout and a nonlinear washout. They differed in the 
types of filters used to washout translational cues. The lin- 
ear washout was seen to present a false rate cue in response 
to a pulse input. A subjective analysis of these two filters 
revealed that this false cue causes pilots to rate the fidelity 
of a simulation using the linear filter much lov;er than the 
same simulation using the nonlinear filter. 

Examination of physiological models of hirnian dynamic orien- 
tation led to the notion that such a model could be useful in 
comparing simulation schemes. The model used in this work, 
conceived by Ormsby, draws primarily on knowledge of the orien- 
tation information provided by processing information from the 
vestibular organs. Time histories fpr different motions were 
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input to the model in order to -evaluate the vestibular reac- 
tion to the linear and nonlinear filtering schemes. It was 
found that indeed the vestibular system reacts differently to 
the motion histories produced by the two filters. 

The next two sections present the conclusions of this work as 
they relate to the following two questions, first posed in the 
introduction : 

• Can the observed differences in simulation 
fidelity between the two filters be explain- 
ed using a physiological model of human dy- 
namic orientation? 

• What are the implications for this model as 
a drawing bpard tool in simulator design? 

The final section suggests avenues for further research in this 
area. 


5,1 The Vestibular Explanation Question 

Figures 5,1 and 5,2 present a recapitulation of figures 
shown in Chapter IV. They are the Ormsby model outputs for 
aileron yaw and rudder yaw cues, respectively, and they pre- 
sent the best cases for a vestibular explanation of the sub- 
jectively observed anomalous rate cues. In each case, the per- 
ceived angular velocity shows the expected gradual rise in re- 
action to the first acceleration in yaw. In the linear case, 
the second pulse {or pulses) causes discontinuities in the per- 
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Figure 5.1 Perceived angular velocity for three 
aileron yaw cue inputs. 
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Figure 5,2 Perceived angular velocity 
rudder yaw cue inputs. 
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ceived velocities. In the nonlinear cases, these disturbances 
are considerably reduced. This. is best seen in comparing the 
simulated velocities with the commanded velocities. It can be 
seen that the nonlinear filter is better able to transfer the 
commanded motions than the linear filter. 

So, the physiological model enables a quantitative eval- 
uation of the differences in washout schemes to become a real- 
ity. It is now possible to know the outputs from the vestibu- 
lar sensors and to deduce a reason for the subjective ratings 
of the two methods. Indeed, there is an anomalous rate cue 
sensed by the vestibular system - it manifests i.tself as a dis- 
continuous perceived angular velocity when the linear washout 
scheme is used, and that discontinuity is lessened considerably 
when the nonlinear scheme is used. 

The physiological model has performed the task demanded 

I 

of it - it provided a vestibular explanation for the subject- 
ively observed differences betvreen the two washout schemes. 

That difference was found in the differing perceived angular 
velocities which are the outputs from the model. 

While this was only a limited test of the perceptions in- 
volved in the motion simulation, it seems to validate the con- 
clusions reached in the Parrish and Martin study. It is also 
an additional validation of, the model - since the predicted re- 
sponse to a pulse input is a gradual rise in perceived angular 
velocity to a maximum, and this is. what was seen in every case, 
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the model appears to be functioning at a level consistent with 
available knowledge of the vestibular output. 

5.2 The Suitability as a Design Tool Question 

The question of the physiological model's appropriateness 
for use as a simulator design tool is a more difficult question 
to answer than the previous one. Certainly one could imagine 
the usefulness of such a model in simulation design. But the 
present case is a very limited one, and the small scope of this 
work should be taken into account in any conclusions which are 
drawn. 

Figures 5.3 and 5,4 present the roll cue.- input cases, as 
first presented in Chapter IV, The roll inputs did not propose 
as compelling a case for a vestibular explanation as the yaw 
inputs. But these figures are offered so that a comparison be- 
tween the aileron and rudder cases can be made. It is import- 
ant to remember that the inputs for the two cases are very dif- 
ferent - the aileron input is basically a pulse doublet, but 
the rudder input is a train of pulses. Prom this narrow inves- 
tigation it is hard to say whether the model really gives an 
accurate picture of the response to a complicated motion his- 
tory such as the rudder pulse train input. 

Assuming the model is proven to accurately portray the ves- 
tibular response to a complicated input, it appears that the 
model is applicable for simulation design purposes. In this 
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case^ had the washout schemes been simulated on the computer 
rather than using a computer onl^ to simulate the aircraft 
which in turn drives the motion base, the same motion histories 
could have been obtained* 'Then^ without the necessity of set- 
ting up an actual motion base, the same time histories could 
have been procured. Once input to the Ormsby model, the out- 
put would have shown the differences in simulation fidelity be- 
tween the two washout schemes. The same conclusions could have 
been reached without ever having to use an actual mechanical 
simulator. 

Thus, assuming the motion history of the part of the sim- 
ulator to be analyzed is sufficiently defined such that a com- 
puter simulation program can be written, the Ormsby model can 
predict pilot perceived angular velocities from that motion 
simulation. There is no need to use an actual mechanical sim- 
ulator, and nor need to employ pilots for subjective analyses. 
The model is able to do the comparisons and predictions with 
confidence. 
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5«3 Suggestions for Further Research 

This work opens up several areas for further research: 

1. It would be useful to understand how certain 
parameters in each of the washout schemes affects the 
resulting motions of the simulator base, and the re- 
sulting perceived angular velocities of the pilot. By 
varying different parameters (such as in the preliminary 
filters or braking acceleration logic) new motion his- 
tories could be obtained. These, in turn, when input to 
the Ormsby model, could provide new insight into the 
workings of washout schemes. 

2. There are several revisions which suggest them- 
selves in regards to the Ormsby model. The necessity for 
tuning could be eliminated were the Kalman filters to be 
replaced by continuous Kalman filters, rather than the 
discrete filters currently in use. Also, more work should 
be done to verify that the model is indeed capable of 
handling complex motion histories. Finally, the model 
might be expanded to include visual and tactile cues, as 
well as the vestibular cues it now employs. 

3. The model should be subjected to more rigorous 
tests of its ability to be used as a simulator design 
tool. One way which immediately suggests itself is to 
take a case such as the one examined here and do the 
testing in the opposite order. That is, run the motion 
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histories through the model, and then let the pilots do 
a subjective analysis. More extensive use of the model 
will suggest areas for improvement, and begin to perfect 
it as a simulator design tool. 
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APPENDIX 

This appendix contains programming material used in the 
work presented in this thesis. The Man- Vehicle Laboratory’s 
PDP 11/34 was the computer used for these FORTRAN programs. 

Most of the documentation for the main Ormsby programs and as- 
sociated siibroutines is taken from Borah [3] . 

A.l Human Dynamic Orientation Model 

The listing which follows is the main module which imple- 
ments the Ormsby model of human dynamic orientation. Several 
changes have been made to the original program (the first three 
by Borah) : 

1, Statements and routines which allowed, for varying 
afferent base rates and additive random noise have 
been eliminated. Thus/ all responses are average 
responses, and firing rates are those;, above the spon- 
taneous rate. 

2, Statements were added to allow for non-zero long time 
constant, (variable TW in the program) . 

3, Comment' cards were added for clarification. 
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4, Statements were added to calculate state transition 
matrices for any given update interval# for both 
canals and otoliths. Vectors TC, TPC# TO and TPO 
are no longer data entries, 

5, -.DATA statements replace data input cards, 

6, Kalman gains GKO and GKS were calculated for a .25 
second update interval# rather than the 1,0 second 
interval used by Ormsby and Borah, 

Table A,1 lists the variables found in this program and - 
their definitions. Several subroutines are needed to use this 
program and they are described in the next sections. Following 
the listing is a sample page of output. Table A, 2 describes 
the output variables seen on this page. 
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0Yf4Ah[-' L-i<Ei:NTATinN PROGRi^iM 


DTHUNBIOH i^NPf201'> ?TC< 474 ) 7 TQ( 3 p 3 ) ?TPC<3ir3) y TPO ( 2 ? 2 ) 7 DMC ( 3 ) y 

1 DUO ( 2 > V r,C ( 4 > y Cf.l ( 3 > y THO ( 6 ) y XCH ( 4 ) y YCH ( 4 ) vZCH ( 4 ) y CS ( 3 > y XOH < 3 ) y 

2 WOK ( 3 > « YOri ^ 3 > V ;<T;S w > : XC ( 3 ) y YO < 3 > ;• ZC < 3 ) y XO < 2 W YO \ 2 ) r OKCi (3> .> 

3 GKSC3) yZn(2* yCTL:<3y3) yCTCK3y3) y VBRC(3) yUBR0(3) ^0(3) yYiC(3) y 

4 GKC<.4) y IUl-i<3) y F0HC3) y TDi i ( 3 ) y TU!S (3 ) y IAS ( 3) yftlU3y y WO ( 3 ) y V ( 3 ) y 

5 D0LD(3) yD!itiv<3 ■ y[:!^S^3> yi£UH(3y yEAH(3) y 14PAF<E ( 3) y WPERP Q 3 y UTOT ( 3 ^ y 
5 ) y USFJ 3 y WiYCO ( 3 ) y IJNCL < 3 ) y l"N ( 3 ) y X F 3 ) y UO < 3 ^ y VG ( 3 ) - VF < 3 y 




DATA S FATEi-iEMTS 


DATA 

DATA 

DATn 

DATA 

DATA 

data 


DPR /57.2'?37B/ 

DT /*2500000000E 00/ 
iH'FP /8," 

NDT /240/ 


DVG /O .224,1 5070 F--04y0. 47300 ;i.20E-03y0, 49530 1S0E~02/ 
CC /~0*255785i0E 02 y ~0 ♦ 1 1318B80E 04 y -0 ♦ <$37;LS550E 04? 
0*A3.4.4I970E 02/ 

Data Hi-r. / -.A , o ! c 1 ••?720E--03 •; 0 * 81.4;L5620E-05y 0 y 1 5035:1 20E-03 y 
0*30559980E-01/ 

FSCC /1^57080000E 00/ 

TDCC /- 0.43a33000E 00/ 


DATA 
DATn 
DAT A 
DA FA 
DATA 
DATA 
Data 

Da '1 1-1 

data 
if. 'Vi A 
DATA 
DATA 
DA"! A 
OA F A 

DATA 

DATA 

DATA 
DATA 
DA FA 
DATA 
Uf.FA 
DA i A 
IJA F A 
DA FA 
DATA 

data 

DA Fa 


8GGC /--tj ♦ '■l>b4000uf- 00/ 

DX'G '/O ^ 47 '■30430I -AJ « 0 » 49058940E-02/ 

CO /usooncoAor: 03.1 .noooooooE o4m0.ooooooooe 00 / 

GKO /O . b9775Li5E-03 y 0 . 53;L0665E-05 y 0 ♦ 10A025S5E-02/ 

GKO /0 . 1.3955:'. 7F-05 . o * 1 0V2133E--04 y 0 »21205 1 iE-02/ 
rU’FO /1,57080E 00/ 

,‘~v 3E 00 

8(J i i) /• ! - rj-'Oi 
8A0i"r0: /O 300Ov4£ OQ' 

G8PG /4*50000i-: 01/ 

Di-A'/ /o, ioooor: oo/ 

Xu! I /O ^ AA y 0 » OOOOCOOOE OO •> 0 i O'lOoOOCOE 00 V 

O^OOOOOO'OOE 00/ 

YC!i .• '■)« oo y 0 1 OOOOC'OOOtl 00 y 0 , 000(:ooOOF 00" 

0*000<OOOOOL aa/ 

ZCl! /O 4 OOOOOOOOE OO y 0 * OOOOOOOOE 00 yO ♦ OOOOOOOOE 00? 
0,OA000000!E 00/ 

XOH /~0 . 05280000iF~ol y -0 , 0-£A.40000E--06 y -0 * 20000000F-. 00/ 
YOi-1 /O^OOOOOOOOE OJ/O.^OOOOOOOOE OOyO.OOOooCOOE CO/ 

Zflli /-O 1 i.3'2'..vjO0!E-“0 L y “ 0 * .1 2A50O00E--06 y -0 > 420000' ■•:■!-: O-V' 
XC /OvOO'MOOOOP 00r0*0o0000-;'0E 00y0*0000o0OOL-; 00/ 

Vr 'A fHf' 'O aOOv'C 00 :■ 0 , 00000'00\)E t)0 V O > 000000( oe Oo/ 

ZC / 0 , ' ‘'O‘' 0 Ai'iA,-.ir f .'.I y A , OfjO'OOOi.'Oi-. Oo y O * OOOOO'JvjOiE 00/ 

UNlA /a, 0Ot?0?"'O'/:E OOyO.OOOOoOOOE 00:-0..0000000oF: 00/ 
WKGI, ''.A 0 <'‘OvOA.o. OslyO^ OOOoOOoOE 00?0 » OOOOOoOOr. Ov;/ 


. . 1 . ; ) > '• 


0 ' 


■0. I., 


l-Oa/ 


YU /O >00O0000<'F OOyO.OOOOOoOOE 00/ 

vij / •Av:;.A:-,.„v'oi: i o./.i-o i.4oor.~o6." 
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C 

c 

c 


c 

c 

c 


c 

c 

c 


10 

15 


c 

c 

c 


20 


27 


DATA DDU'i /0,OOOOOOOOE- 00«0*000000O0E OOs- -1 .OOOOOOOOE 00/ 
DATA WSFO /0*00000000E 00 j 0 ♦ OOOOOOOOE OOs-0*OOOOOOOOE 00/ 
DATA WOF /O.OOOOOOOOE 00 ? 0 ♦ OOOOOOOOE 00i-0*00000000E 00/ 
DATA TDUEL /3 ♦ 5'OOOOOOOE 01/ 

DATA TDPOS /6*OOOOOOOOE 01/ 

DATA TNG /0*25000000E 00/ 

DATA FNOISE /0»OOOOOOOOE 00/ 


SET UP FILE ASSIGNMENTS 

CALL ASSIGN (21 ? "DKl :DBLT*NON" ) 
CALL ASSIGNC22? 'DKlJRESULTtSAR' ) 
WFaTE< 22 i^ 5 ) 

FORMAT LINEAR AILERON ROLL 1 


WRITE <22 i- 700) DTyNITP 
WRITE(22y705) 


CANAL SPECIFICATIONS 

CALL STMCaiT/NITPrTPCyTC) 

DO 10 1=1 

WRITE (22y 710) TC (I y 1 ) y TC (I y 2) y TC ( I y S) ? TC< I y4) 

DO 15 1=1 y 3 

WRITE ( 22 y 720 ) TPC (I y 1 ) y TPC < I y 2 ) y TPC ( I y 3 ) v DOC < I ) 
WRITE < 22 y 730 ) CC ( 1 ) y CC < 2 ) y CC < 3 ) ■■ CC ( A ) 
WRITE<22y/40) GKC ( 1 ) y GKC < 2 ) y GKC ( 3 ) y GKC ( 4 ) 
WRITE(22y750) FSCCyTSCCySSCC 
CALL EULER ( FSCCy TSCC y SSCC y CTC ) 

WRITE ( 22:- 765) 

OTOL IT( 1 SPE Cl F I C ATI ONS 


CALL STMO (DT y NITP y TPO y TO ) 

DO 20 I = !.y3 

WRITE<22y770) TO < I y 1 ) y TO ( J y 2 ) yT0(Iy3> 


no 25 1^=1 y 2 
WRITF<22y 700) 
WRITE<22y/90) 
WRITE ( 22 y BOO) 
WRTTE(?2"B:I0) 


TPO ( I TPO < X " 2 ) y DUO ( I ) 
C0< L)yC0(2) yC0(3) 

GKO ( i ) y GivO ( 2 ) y GKO ( 3 ) y GKS < 
FO rn y TOT!'} ■■ SOTO y SACi ViC y OGi- 


CALL EULER (FOfQy TQ TO y SOTO y CTO ) 


CS < I ) -CO ( r ) l^SACFAC 
WRi:TE(22y025) 


I) yGKS(2) yGKb'(3) 
GyDFAC 


C 

C 


INITIALI2AT10N 


DO 32 r--Jy4 

WRl ri£ ( 22 y S30 ) XCH < I ) y YC! K T ) y ZCH < T ) 
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A (1 ) ==XCH ( 4 ) 

A<2)=YCH(4) 

A(3)=2CH(4) 

CALL CQTRN(A?CTC/1jW 0) 
no 36 I~t^3 

36 URITE<227836) XOH ( I> ? YOH (I ) ? ZOH ( I ) 

A<1)=X0H(3) 

A(2)=Y0H(3) 

A(3)-=Zni-lC3) 

CALL C0TRN(A7CT0?ijA0) 

DO 45 I=iy3 

45 WRITE (22 7 850) XC ( I) 7 YC (I ) ? ZC ( I ) 

DO 50 1=1-2 

50 WRITE(227855) XO ( I) ? YQ ( I ) y ZO ( I ) 

WRITE<227875> HOLD (1 ) y IlGLE! ( 2 ) y D0LIK3 ) 

FP=1» 0-EXP (“DT/IDPOS) 

FD=TDVEL 

WRITE ( 22 y 880 > TDOEL y TDPQS y TNC y FP y FNDISE 
■ FN(l)=EXP(-nT/TNC) - 
FN ( 2 ) =TNC:K ( 1 ♦ -FN ( 1 ) ) /DT-FN ( 1 ) 

FN ( 3 ) = i . -TNC-.K ( 1 ♦ -FN ( 1 ) ) /DT 
C 

C MAIN PROGRAM CYCLE 

C 

C 'find current STIMULUS IN HEAD COORDINATES 

C (EVERY DT/MITP SECOt 

C ANGULAR ROTAflDN VECTOR (TWH) AT (TIME) » 

C‘ 2* SPECIFIC FORCE VECTOR (TAH) AT (TIME+DT/Z). 

C 3* TRUE DOWN VECTOR AT ( TIME-KiT/2 ) . 

C 

DO 450 ITIME=iyNDT 
DO 100 I--=l“NirP 
TIME= (ITIHE-1 ) '1 cDTtI! 1<DT/NITP 
CALL STIM ( TIME? TUHy TAH yTDH) 

TRANSFGi^ii TO SENSOR COORDINATES 

CALL. COTKN(TWHyCTCyOy rWS) 

CALL COTRN (TAH y CTO y 0 - TAS ^ 

SENSOR STIMULATION (EVERY DT/NITP SEC-)^ 

USING CURRGNr STIMULUS OnLUES? UPDATE STATE 
VECTORS FOR 3 CANALS (XCy YC AND ZC)y AND 
3 OTOI.ITI^S CMJyYU AND ZU^- AND COMPUT!:' 

AFFERENT FIRTNO i<ATES C CSX y CHY y CSZ y USX - 03 Y y OSZ ) . 


S«TWS ( 1 ) 

CALL SVUPU ( XC y TPC y UVC y 8 y CSX y CC y 3 y 4 ) 
S~TW3(2) 

(JALL SVUFD < YC y VVC y DVC y S y CSY y CC y 3 y 4 ) . 
S=TWS(3^ 

CALL SVUITKZC s TPC y OVC y 8 - CSZ - CC - 3 y 4 ) 


OKIGINAL 
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S~TAS ( 1 ) 

CALL SVUPEKXOyTPOjDVfJySv 0SX?C0?2?3) 

S=TAS(2) 

CALL S^^UPO < YO y TPO ? DVO ? S 7 OSY ? CO y 2 7 3 ) 

S=TAS<3) 

100 CALL SyUPD(Z07TP070007S70SZyCS7273) 

OPTIMAL ESTIMATOR (UPHATE EUERY DT SEC* ) J 

GET CANAL AND OTOLITH SYSTEM STATE ESTIMATES FROM 
STEADY STATE KALMAN FILTERS* 

CALL SSKF(XCH7CSX?TC7CC7GKC74) 

CALL SSKF(YCH7CSY7TC7CCyOKC74) ' 

CALL SSKF(ZCH7CSZ7TCyCCpGKC74) 

CALL SSKF ( XOH y OSX y TO y CO y GKO y 3 ) 

CALL SSKF ( YOH y OSY y TO y CO y GKO y 3 ) 

CALL SSKF(Z0Hy0SZyT0yCSyGKSy3) 

ENTER ROTATION RATE ESTIMATE VECTOR (CANAL ESTIMATE)* 

EWSa>=XCH(4) 

EWSC2>=YCH(4> 

EWS(3)=ZCH(4) 

ENTER SPECIFIC FORCE ESTIMATE VECTOR (OTOLITH ESTIMATE)* 

EAS(i)=X0H(3) 

EAS(2)=Y0H(3) 

SACCULE NON-LINEARITY 


EAS { 3 ) =AMAX1 ( * 6)!< ( ZOH ( 3 ) + * 41 69 ) 


4169y-*4;i.69) 


RESTORE MAGINITUDE OF OTOLITH ESTIMATE TO VALUE HELD 
BEFORE CONSIDERATION OF SACCULE NON-LINEARITY, 

( THEREFORE y NON-LINEARITY EFFECTS ONLY DIRECTION OF 
OTOLITH ESTIMATE)* 


CALI. •NORM(EASyY) 
no 130 1=1 y 3 

nUMMY=XOH < 3 ) SJIC2+Y0H ( 3 ) ’■KSCT ZOH C 3 ) 

30 EAS ( I ) =SORT ( DUMMY ) ( I ) 

TRANSFORM TO HEAD COORDINATES 

CALL COTRN ( EUS y CTC y 1 y EWH ) 

CALL COTRN ( EAS y CTO y 1 y HAH) 

PRINT STIMULUSySENSOR AND OPTIMAl.. ESTiiMATOR VALUES* 
WRITE ( 22 y 900) TIME 

WRI TE < 22 y 7 I (' ) TWH ( n y TITS Cl ) v CSX y EWH ( 1 y TAH ( 1 ) •• TAS ( 1 ) y 
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1 0SX7EAH<1) ?TDH(t) 

URITE(227?10) TWH<2) ?THS(2) 7 CSV 7 EWH (2 ) 7 TAH ( 2 ) f TAS ( 2 ) 7 
1 ■ OSY 7 EAH <2)7 TDH < 2 ) 

WRITE(227910) TWH(3) 7TWS<3) 7 CSZ 7 EWH <3 ) 7 TAH (3 ) 7 TAS (3 ) 7 
1 0SZ7EAH(3) 7TDH(3) 

WRITE <22 7 920) 

C 

C DOWN AND W ESTINATOR <UPDATE EOERY DT SEC*)* 

C COMBINE OTOLITH AMD CANAL ESTIMATES TO FORM 

C NEW ESTIMATE QFt 

C 1* PERCEIVED DOWN <DNEW) AT <TIME+DT/2)* 

C 2* PERCEIVED ACCELERATION <ACC) AT <TIME+DT/2) * 

C 3* PERCEIVED ANGULAR VELOCITY <WTOT) AT <TIME)* 

C 

CALL DOWN < DOLD 7 EWH 7 EAH 7 AO 7 WSFO 7 FD 7 DT 7 TDPOS 7 DFAC 7 WOF 7 
1 WNCO 7 WNCL 7 FN) 

450 CONTINUE 

C 

C FORMAT STATEMENTS 

C 


700 FORMAT< //f' UPDATE INTERVAL” ' 7 F5 *27 ^ SECONDS * '7 
1 'NUMBER ITERATIONS PER INTERVAL=’' 7 13 -^ // ) 

705 F0RMAT<//7' semi-circular CANAL SYSTEM SPECIFICATIONS'?/) 

710 FORMAT< ' CANAL TRANSITION MATRIX==' 74E15*S) 

720 FORNATC ' CANAL SYS UPDAIE MATRIX--^' 73E15*87 

1 ' CANAL DRIVING VECTOR:^ ' 7 E15 * 8 ) 

730 F0RMAT</7' canal SYS OUTPUT MATRIX=' 74E15*87/) 

740 FORMAT! ' CANAL SYS KALMAN GAINS ='74E15*8> 

7.50 F0RMAT</7' canal ORIENTATION WRT HEAD PHI:^'E12*57 
1 ' THETA=' 7 EI 2.57 ' PSI==' 7E12.5»/) 

765 F0RiiAT<////7 ' OTOLITH SYSTEM SPECIFICATIONS' »/) 

770 FORMAT< ' OTOLITH TRANSITION MATRIX^ ' 7 3E15 * 8) 

780 FORMAT< ' OTOLITH SYS UPDATE MATRIX^ ' 7 2E1S ♦ 8 7 

1 ' OTOLITH DRIVING VECTOR-”' 7E15*8) 

790 FORMAT</*' OTOLITH SYS OUTPUT MATRIX^' ? 3E15 * 8 ) 

800 F0RMAT</7' UTR KAL GAINS=' 73Ei2*57 ' SAC KAL GAINS==' » 

1 3E12*5) 


StO F0RMAT</7' OTOLITH ORIENTATION WRT HEAD PHI=='» 

■ .1 £12*5?' IHETA^' 7E12*57 ' PS ' 7 EI2 *5 7 / 7 

2 ' ' SACFAC-' 7E12*57 ' O SENS PER G-=='7 

3 £12*5?' 0 SYS GAIN <DFAC)=' 7E12,57/) 

'/V 7 ' SYSTEM INITIALIZATION' 7 //) 

INITIAL STATE ESTIMATES* XCH 7 YCH 7 ZCH = ' 7 

. 8 ) 

INITIAL -STATE ESTIMATES* XOH 7 YOH ^ ZOH=--:= ' - 

. 8 ) 

TRUE CANAL STATE VECTORS XC7YC7ZC='7 

. 8 ) 

TRUE OTGI/nH STATE VECTORS XO 7 YO 7 ?. 0 =^ ' 7 3rt5 ♦ 8 
.DOLDd 7 273) = ' 7 3£12*57/> 

DOWN ! CA TE T---= ' 7 E 1 2 ^ 5 7 ' DOWN POS T--- ' 7 E 1 2 , U 7 


825 


FORMAT< ' 1' 

830 


FORMAT < ' 


1 

3E1 

836 


FORMAT! ' 


1 

3EI 

S50 


FORMAT! ' 


1 

3£I 

B55 


FOl^MAT! ' 

875 


FORMATt/7 ' 

880 


F ORMAT < / 7 ' 
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STOP 


900 

910 

920 


' NON CQNF T CONS= ' » E12 ♦ 5 ? ' POS ERF<0R I-hO 
E12. 5. /^ SIGNAL NOISE FACTOR FNOISE=' ri-.12 .b 


SYSTEM SIMULATION' »/////) 


FORMAT(' T='yF6+2f' 
'C EBT W Hfl . 
■^0 EST SF 
FORMAT (' 

FDRMAK' ' 

'WPARE 


,2f' W HD 
Hfl . SF HD 
down HD ' ) 
^ ,9E12*5) 
RSCC 
NPERP 

ACC' ) 


W SENS 
SF SENS 


ROTO 

UTOT 


0 SIG 


RPOS 
DNEW' 7 


STOP 

END 
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Table A.l Variables used in main program 


AO (I) 

CC(I) 

CO (I) 

CS(I) 

CSX(I), CSY(I), CSZ(I) 

CTC(I,J) 

CTO(I,J) 

DPAC 
BOLD (I) 

DPR 

DT 

DVC(I) 

DVO(I) 

EAH(I) 

EAS(I) 

EWH(I) 

EWS(I) 

FD 

PN{I) 

PNOISE 

FOTO, SOTO, TOTO 
PP 

FSCC, SSCC, TSCC 

GKC(I) 

GKO (I) 

GKS(I) 


old otolith estimate 

canal sensor output 

utricle sensor output 

saccule sensor output 

current canal state vectors, sensor 
coordinates 

direction cosine matrix between head 
and canal, sensor coordinates 

direction cosine matrix between head 
and otolith, sensor coordinates 

steady-state gain of otolith estimate 

old DOWN value (=,46) 

degrees per radian (=57.29578) 

update interval for DOWN estimator 

canal sensor driving vector 

otolith sensor driving vector 

current otolith specific force esti- 
mate, head coordinate's 

current otolith specific force esti- 
mate, sensor coordinates 

current canal angular velocity esti- 
mate, head coordinates 

current canal angular velocity esti- 
mate, sensor coordinates 

= TDVEL 

constants for first-order filter 

signal-to-noise factor 

Euler angles for head and otolith sen- 
sor coordinate transform 

position error factor 

Euler angles for head and canal sen- 
sor coordinate transform 

canal Kalman gains 

otolith (utricle) Kalman gains 

otolith (saccule) Kalman gains 
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Table A.i 

NDT 

NITP 

OSPG 

OSX(I) , OSY(I) , 

SACPAC 

TAH(I) 

TAS(I) 

TC(I,J) 

TDH(I) 

TDPOS 

TDVEL 

TIME 

TNG 

TO(I,J) 

TPC(I,J) 

TPO(I,J) 

Md) 

TWS(I) 

WNCL(I) 

WNCO(I) 

WO (I) 

WOF(I) 


continued 


length of motion history 

number of sensor updates per DT 

otolith afferent firing rate per g 

OSZ(I) current otolith state vectors, sensor 
coordinates 

saccule factor (-.5) 

current stimulus specific force, 
head coordinates 

current stimulus specific force, 
sensor coordinates 

state transition matrix for canal 
Kalman filters 

DOWN 

60 second time constant for DO^'^N 
position 

35 second time constant for DOWN 
angular velocity 

current time in seconds 

•25 second time constant for uncon- 
firmed canal estimate 

state transition matrix for otolith 
Kalman filters 

state transition matrix for canal 
sensor update 

state transition matrix for otolith 
sensor update 

stimulus angular velocity, head 
coordinates 

stimulus angular velocity, sensor 
coordinates 

low frequency portion of WNCO 

previous unconfirmed canal angular 
velocity estimate 

old otolith estimate 

low frequency portion of otolith 
angular velocity estimate 



Table A.l 


WSFO(I) 

XC(I) , YC{1) , ZC(I) 
XCH(I), YCH(I), ZCH(I) 
XO(I), YO(I), ZO{I) 
XOH(I) , YOH(I), ZOH(I) 
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Ill 



T= 0.25 U HD W SENS C SIG C EST U HD tiF HD 8F SENS D SIR 0 EDT SF DOWN HD 

-0.2a9yOC-03-Q.14733E-03-O.A6307E-02-0.220U2E--()3 O.OOOOOE hOO-0 . ^22A2Et (JO-0 .53776EI 02-0 .70889E-02 O.OOOOOEIOO 
O.OOOOOEFOO 0.14733E-03 0.463Q7E-02 0.50V27E-11 O.OOOOOE 1 00-0 . 15U4E-05-0 . 12504E-Q3 0.S76<4-}E-06 O.OOOOOEIOO 
O.OOOOOEIOO 0.9715BE-04 0.30537E-02 0 , 72760E-11-0. lOOOOE+01-0 . 90631E 1 00-0. 57076E+02-0 . 47381E 100-0, lOOOOEI 01 
RSt:c RUTO RPOS MPARE WPERP UTUT DNEW AOC 

0.34896E-04 0 .’aaSiiAE-OS-0, 14106E-06-0 , 553V4E-12 0, OOOOOllKOO-0 . S5394E-12-0 . 10020E-03 0.7842aE-02 
-0.804B0E-12 0.30S99E-04 0.69605E-04 0.19214E-12 O.OOOOOEIOO 0.19214E-12 0.34737E-04 0,iS412E-04 
-0.53390E-09 O.OOOOOEIOO 0 .24334E-0B-0 . 1 1056E-07 O.OOOOOEIOO-O. U0S6O07-0. lOOOOEIOl 0.1300AE-01 
T= 0,50 U HD W SENS C SIR C EST U HD SF HD SF SF.NS 0 SIB 0 EST SF DDIJH HD 

-0.13216E-02-0.84697E'03-0,26655E-01-0.11467E-02 O.OOOOOEl 00-0. 422A2E 1 00-0. 50000EI 02-0. 3564<iE:-0a O.OOOOOEIOO 
O.OOOOOEIOO 0.84697E-03 0.266SSE-01-0.68S52E-10 0 .OOOOOtl 00-0.151 14E-0S-O . 114 17E-03 0.4B120E-06 O.OOOOOEIOO 
O.OOOOOE+OO 0.S5854E-03 0. 17578E-01-0.58208E-10-0 . lOOOOfi t-Ol-0 .90A31E+00-0 . 53622EI 02-0. 471Q7EI 00-0, lOOOQEl 01 
RSCC fillTO RPOS tJPARE WPERP WTDT DNEM ACC 

0. 15916E-03-0,lD441E-06-0.(10650E~04-0,2736<i.E-10 O.00O0OCh0O-O.273i6E-10-O,20D7OE-03 O.64606E-O2 
0.12036E-10 0.50930E-04 0.57570E-04 0.20176E-10 O.OOOOOEIOO 0.2017AE-10 0.19299E-03 0.88294C-04 
-0.20002E-07 0.17ri27E-0B 0.11279E-07-0. 17718E-06 O.OOOOOE+00-0. 17718E-06-0. lOOOOE+Oi 0.1I875E-01 
T= 0.75 U HD H SENS C SIB C EBI M HD SF HD 8F SENS 0 SIB 0 EST SF DOWN HD 

-O.Bt713E-03-O.S23<56E-03-0.16397E-01-0.33094E~04 O.OOOOOEI 00-0. 42262EK)0-O,46234EI 02-0. 22724E-02 O.OOOOOEIOO 
‘ O.OOOOOEIOO 0.52366E-03 0.13397E-01 0.34253E-10 0 , OOOOOE 100-0 . 15114E-05-0 . 103U2E-03 0.41163t;-06 O.OOOOOEIOO 

O.OOOOOEIOO 0.34S33E-03 0.10813E-01 0 . 26375E-10-0. lOOOOE FOl-0 . 90631EI 00-0 . 4957SE+02-0 . 46210EI00-0 . lOOOOEI 01 
RSCC ROTO RF>riS UPARE UPCKP WTO I DNEW ACC 

-0.11744E“03-0.35S4DE-04-0.30B99E-06-0.i<i374E-ll O.OOOOOE 100-0. 16374E-11-0.23696E:-03 0.21434E-02 
-0.14900E-10 0.B7139E-05 0.19546E-04 0.9D417E-12 O.OOOOOEIOO 0.9B417E-12 0.74B86E-04 0.34036E-04 
O.nsoaaG-O? 0,17559E-OB 0,15369E-OB-0,73480t-00 0 . OOOOOE 1 00-0 . 734QOE-O0-O . lOOOOEI 01 0.20962E:-02 
r=< 1,00 (J HD W SENS C SIG C ESI U HD SF HD SF SENS 0 SIG O EST SF DOWN HD 

0.13SR2EIOO 0.87039E-01 0.27349E+O1 0.13112EE00 O.OOOOOE 1 00-0, 42242E (00-0. 42645EI 02 0.74att9E-03 O.OOOOOEIOO 
O.OOOOO£nOO-O,07O39E-Ol-O,27349EIOl 0.20197E-0B 0 . OOOOOEI 00-0 , 15114E-0S-0 . 9390AE-04 0.35678E-06 O.OOOOOEIOO 
O.OOOOOE 1 00-0. 57398E-01-0,18036EK>1 0. 7450AE-0B-0 . lOOOOEEOl-0 . 90431E+00-0. 45724EI 02-0 . 4465AE+00-0. lOOOOE 1 01 
RSCC RmO RPOS lOPARE MPERP UTOI DNEW ACC 

-0.20769E-01-0.17rj33E-05 0.BS41SE-04 O,575E!5E-0B 0 ,8272<!>E-01 0,B2724E-01-0,iri209E-03-0.n4646E-03 
-0 . 1 0041 E-06-0.4AC27E-04-0 . 78335E-05 0. 28216E-06 0 .21 926E-03 0 , 21954E-03-0 , 20609E-01-0 . 94803E-02 
0.44351E-0S-0.30n41E-08 0.14S92E-06 0 ,274ftOE-04-0. 195£I7E: -04 0.7Q934n-OS~0.99979EIOO-0.13347E-01 
T= 1.25 U HD U SE.NS C SIG C E8T U HD SF HD SF SENS Cl STB U EST SF DDUN HD 

0.03301E:iOO 0,40307E(-00 0.12696EI02 0, 532S2E400 0 . OOOOOE 1 00-0 . 42262F, KK)-0 . 39230E 102 0.39591E-02 O.OOOOOEIOO 
O.OOOOOEI 00-0, 4O5A7EEOO-O.1209OE (02-0, 16337E-07 0 , OOOOOE 1 00-0 . ISl 14E-05-0 . 84027E-04 0.31517E-06 O.OOOOOEIOO 
O.OOOOOE! 00-0, 267S2EEOO-O.03721EI-O1 0 , OOOOOE+OO-0, J OOOOE W)1~0 . 90631 E 1 00-0 . 42044E+02-0. 42A91EI 00-0 . lOOOOE 1 01 
RSCC ROTO RPOS UPARE UPERP UIOT DNEW ACC 

-0.71074E-01 0.30791E-.''4 0.37403E-03 0.1242SE-07 0.2U205EIO0 0 . 282(!iSE 1 00-0 . 12507E-03-0. 40170E-02 
-0.27924E-06-0.10877E-04-0.3B413E-04 0.45845E-05 0.22297E-03 0 ,227g0£:-03-0 . 91140E-01-0 .41920E-01 
0.12351E-04 0.3411BE-06 0.346B7E-05 O.B1866E-04-0.56076E-04 0 .25790E-04-0. 99S04EI00-0. 31174E-01 
T= 1,50 M HD W SENS C SIG C EST U HD SF HD SF SENS 0 SIG 0 ESI SF DOWN HD 

0,0520ir;+00 0,41834E+00 0.12946E+02 0.25746E+00 O.OOOOOEI 00-0 . 42262E+00-0.3S981Ei+02 0.73B46E-02 O.OOOOOEIOO 
O.O()0O0E(OO-0.41U36EfOO-0.12946E!02 0.02002E-07 O.OOOOOE 100-0. 15114E-05-0 .75725E-04 0.2B412E-00 O.OOOOOEIOO 
O.OOOOOE 100-0. 275B9E+OO-O.05374E+O1 0 , 74SOOE-O0-O . lOOOOE 1 01-O.90631EfOO-O .3B581E:I 02-0. 40442EI00-0. lOOOOEI 01 
RSCC ROTO RPOS WPARE UFERP WTOT DNEW ACC 

0.17321E-01 0.29975E-04 0.29762E-03 0.187S7E-OB-0.70600E-01-0.70000E-01-0.449B1E-04-0.740S3E-02 
-0,74995E-00-Q,60212E-OS-0,73B62E-04 0,lBi04E-05 0.32217E- 03 0.32390E-03-0.735r,fSF.“01-0,33B37E-01 
-0.20646E-05 0.54732E-06 0.5434SE-05 0 . 21900E-04-0 . 2057BE-04 0 i 1329SE-05-0. 99729E+00-0.S4335E-01 
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Table A, 2 Variables output from model 


W HD 
W SENS 

C SIG 

C EST W HD 

SF HD 
SP‘ SENS 
O SIG 

O EST ST 

DOWN HD 

RSCC 

ROTO 

RPOS 

WPARE 

WPERP 

WTOT 

DNEW 

ACC 


angular velocity vector, head coordinates 

angular velocity vector, sensor coordi- 
nates 

canal signal: afferent firing rate from 
three canals 

canal estimate of angular velocity vector, 
head coordinates 

specific force vector, head coordinates 

specific f or ce ■ vector , sensor coordinates 

otolith signal: afferent firing rate from 
three otoliths 

otolith estimate of specific force vector, 
head coordinates 

unit vector in direction of gravity, head 
coordinates 

canal contribution to DOWN, head coordi- 
nates 

otolith contribution to DOWN, head coor- 
dinates 

rotation vector to null difference between 
^ and DOWN 

angular velocity perception parallel to DOt^N, 
head coordinates 

angular velocity perception perpendicular to - 
DOWN, head coordinates 

total perceived angular velocity, head coor- 
dinates 

perceived DOWN vector, head coordinates 

perceived acceleration vector, head coordi- 
nates 


ORIGINAL PAGE B 
OF POOR QUALiry 
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A«2 Subroutine STIM 

Subroutine STIM is the 'stimulus routine called by the 
main program. It is this program which is altered for differ- 
ent applications of the model. The particular subroutine 
listed here is the one used in this thesis research. Basic- 
ally, it reads the data from the Langley motion histories from 
a file on a disk. The desired angular velocities are placed 
in the proper angular velocity vector locations by this pro- 
gram. Table A. 3 lists the filenames, data locations and vector 
locations for each of the twelve cases, examined. . Table A. 4 
lists the variables used in this program, and their definitions. 

Note that the STIM routine must return staggered angular 
velocity and specific force values, as required by the main 
program. The value of W must correspond to time T, while the 
values of A and D must correspond to time T+DT/2. This require- 
ment is illustrated in Table A. 5, which also gives the print- 
out times for the variables which are output from the main pro- 
gram. 
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SUBROUTING SriM<T? W p A sD> 

OTNENSION W<3>f AC3) ?D<3) 

BPR^ST 4 29578 
IfO iO 1=1 >3 

wa)“0,o 

IK I) =0,0 
10 A<I)=OfO 

A(3)=-1.0 
D(3)=-l«0 
DO 20 I==l. 1-5 

READ(21yl5?EftR«16) (BATA( J) . 

15 F0RHAT<1Xs-6E13*<S) 

GO TO IS 

16 WRIT£i7,15} COATA(K) /K~l3.S) 

18 ll-a.EQ*2> U(l)-TiATAa>>!{T/DPR 

20. CONTINUE 

RETURN 

END 


STOP 
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Table A. 3 Twelve test cases used by STIM 


CASE 


FILE NAME 

Simulated aileron . 
linear roll 

DBLT.LIN 

Simulated 

nonlinear 

aileron 

roll 

DBLT.NON 

Commanded 

roll 

aileron 

DBLT.LIN 

Simulated aileron 
linear yaw 

DBLT.LIN 

Simulated 

nonlinear 

aileron 

yaw 

DBLT.NON 

Commanded 

yaw 

aileron 

DBLT.LIN 

Simulated rudder 
linear roll 

RUDDR.LIN 

Simulated 

nonlinear 

rudder 

roll. 

RUDDR.NON 

Commanded 

roll 

rudder 

RUDDR.LIN 

Simulated rudder 
linear yaw 

RUDDR.LIN 

Simulated 

nonlinear 

rudder 

yaw 

RUDDR.NON 

Commanded 

yaw 

rudder 

RUDDR.LIN 


DATA NAME &. 
LOCATION * 

ANGULAR VELOCITY 
VECTOR LOCATION 

PDOTM 

(4,2) 

1 

PDOTM 

(4,2) 

1 

PADOT 

(2,1) 

1 ■ 

RDOTM 

(4,4) 

3 

RDOTM 

(4,4) 

3 

RADOT 

(2,5) 

3 

PDOTM 

(4,2) 

1 

PDOTM 

(4,2) 

1 

PADOT 

(2,1) 

1 

RDOTM 

(4,4) 

3 

RDOTM 

(4,4) 

3 

RADOT 

(2,5) 

3 


* Data location taken from a 5 X 6 matrix of variables 
listed in' Table 4.1 
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Table A. 4 Variables used in STIM 

A (I) stimulus specific force, head coordinates 

D<I) unit vector aligned with gravity, head coor- 

dinates 

T current time in seconds 

W(I) stimulus angular velocity, head coordinates 


original page is 

OP POOR QUALITY 
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Table A, 5 STIM variables and printout variables [3] 


VARIABLE 

COORDINATE 

FRAME 

UNITS 

STIM - 
VALUES 

T+DT/2 

COMPUTE 
AT TIMES 

T 

PRINTOUT 
VALUES AT 

T+DT/2 

TIMES 

T 

, A 

head 

g 

X 




D 

head 

g 

X 




W 

head 

rad/sec, 


X 



W HD 

head 

rad/sec 




X 

W SENS 

sensor 

rad/sec 




X 

C SIG 

sensor 

ips 




X 

C EST W 

head 

rad/sec 




X 

SF HD 

head 

g 



X 


SF SENS 

sensor 

g 



X • 


0 SIG 

sensor 

ips 



X 


0 EST SF 

head 

g 



X 


DOWN HD 

head 

g 



X 


RSCC 

head 

rad 




X 

ROTO 

head 

rad 




X 

RPOS 

head 

rad 




X 

WPARE 

head 

rad/sec 




X 

WPERP 

head 

rad/sec 




X 

WTOT 

head 

rad/sec 




X 

DNEW 

head 

g 



X 


ACC 

head 

g 



X 




118 


A« 3 Subroutine DOWN 

. Subroutine DOWN implements the logic for determining the 
perceived direction of gravity and the .perceived angular vel- 
ocity, Figures 3.7 and 3,8 illustrated this logic, and it was 
discussed in Chapter III, Table A, 6 provides the list of var- 
iables used in the subroutine along with their definitions. 



.{» w w 
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C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 


10 


11 

12 


13 


SUBROUTINE DOWN < BOLD » WN ? SN ? SO / WSFO y T y BT yTIfPS y 
1 BFACyUOFy WMCOyWNLyFN) 


DOWN ESTir^ATQR AND U ESTIMATOR 


DOWN IS DETERMINED BY RELYING ON LOW FREQUENCY 
OTOLITH ESTIMATESy CANAL ESTIMATES WHICH ARE 
CONSISTENT WITH HIGH FREQUENCY OTOLITH ESTIMATES? 
AND HIGH FREQUENCY PORTION OF CANAL ESTIMATES 
NOT CONFIRMED BY OTOLITHS* 

W IS DETERMINED BY CANAL ESTIMATES PARALLEL TO 
DOWNy ROTATION RATE OF DOWN? AND HIGH FREQUENCY 
PORTION OF CANAL ESTIMATES PERPENDICULAR TO 
DOWN MINUS ROTATION RATE OF DOWN* 


DIMENSION DOLIKS) rWN<3) ySN(3) y S0<3) yWSF0(3) yF(3> y 
1 ■ WSF<3) yX(3> yW0F(3) yRSCC(3> yR0T0(3) yRT0T(3) y 

DNEWC3) yRP0S(3) ?WPERP(3) ?DAUG(3) y WPARE(3) y 
WT0TC3) yACC<3) yANG<3) yWDD<3) rW0DN(3) y 
WNC0<3) yWNL(3) y FN < 3 ) ? WNC < 3 ) y WNCH ( 3 ) y HROTO (3) 


SFN AG=SQRT < SN ( i ) ;K:K2+SN ( 2 ) ^JK2+SN ( 3 ) :}t^2 ) 
FP0S=1*0-EXP<“( (SFMAG/DFAC);K>!<( *25) ))KDT/TDPS) 
TDMEL=T 

F ( 1. ) =EXP < -DT/TDUEL ) 

F < 2 ) =TDUELJK (1 * -F (1 ) ) /DT-F ( J. ) 

F<3> = l*-TDVEU!fa*-F< 1) )/DT 
CALL CROSS ( SO ySNyWSF) 

CALL N0RM(WSFy'.O 
Ci-’tLL UANG ( SO y SN y ANGBF > 


DO 10 1=1 y 3 
WSFa)=ANGSFX<X<I) 

WOF ( I ) =F ( i ) >KWOF C I ) -IF ( 2 ) :^iWSFO ( I ) +F ( 3 ) ;!<W3F ( I ) 
WOD ( I > =WSF ( I ) “WOF ( I ) 

WSFO(I)=WOF(I) 


WODM=SQRT ( WOD ( L ) ;'r4c2-:- WOD < 2 ) :K;K2+W0n C 3 ) rr ?. ) 


CALL NORM ( WOD yWODN) 

W CPWD=WN ( 1 ^ .TWODN ( 1 ) +UN < 2 ) '^'<WODN ( 2 ) -f WN ( 3 ) :;<WODN ( 3 ) 
IF(WCPWri) t2yl2yll 


WCPWD=0*0 
W M ft G = - W C P W D if; D T 
DO 13 1 = 1 y 3 

X (I ) =WODN ( I ) .TAM INI ( WMAG y WO OM ) 

WNC 1 1 ) =“WN ( I ) TD r~X ( I ) 

WNL ( I ) =FN ( L ) TWNL ( I ) -f-FN ( 2 ) TWNCO ( I ) +FN ( 3 > YWNC ( I ) 


WNCO<I)=WNC(I) 

WNCl K I .) =WNC ( I ) “WNL < I ) 
X(I)=X(T^{ WNCH(I) 

CiW.L CRGS") DOLD y SN y ROTO ) 
I? ALL NORi'KRUrOyF) 


Of POOE 
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15 


20 


30 


40 


45 

50 

100 


WOPAK’h=UiC'i- ( J. > .rr ■; ,i. ) fWOI- ( 2 > JIJF' ( 2 ) +WOF ( 3 ) :!<F < 3') 

BCj 15 X = 1. ■» 3 

ROTO( t:’>==i=;5Pi'iR!l>:;!- (I) 

HROTO a ) ==100TQ a ) /2 » 

CAi.L ROT--< T E ( ut }LD - H':-nTn , F > 

WCFnRi i“X C !. ) -ici" ( I. ; -f X < 2 ) ;I<F ( 2 > -f X ( 3 ) 5J!F < 3 ) 

DO 20 I-=1 »3 

RSCC a ) =: .1. ) -WCPARhFfCF ( I) ) 

RTOT < X > =^;;ror.c ( i ; +koitj ( i ) 

CALL ROTA TF C OfiLl'i f RT 0 T . DMEW ) 

CALL X'ANC f DHEU y SN y FEE > 

PHI=FPOS-'^FEE 

CALL CROEC ( 10 ‘EW s SW ? RP03 ) 

CALL NQRf-KRPOBi-X) 

DO 30 .l>1y3 
RPUS < I ) ==r H X i<X ( I ) 

CALL ROTATE ( DMEW » RPOS X ) 

CALL - NOKi'i(X»'OMEy) 

DO 40 1=1 y 3 
X < I ) =DOLD C I ) TpT'iEW ■ ] > 


UP ARM=WM < 1 ) ■;KD AOG ( 1 ) +UN < 2 ) )KDAOG ( 2 ) +UN { 3 ) iKDAVG (3 ) 

CALL CROCS C DPEU y BOLD y WPERP ) 

CALL UPrRP-X) 

CAS L VAMGfOnLDvAMFUyPHn 
HO X=iy3 
UPERPCO=X< I ;;rirHT./ni 
UPARE ( X ) =UPARMXnAUG C X ) 

DCi.iK i:)--=:'!i-;Ev:<T 5 

SO(I)=:SN^ r> 

UTOT ^ C ) EP P I > -PCPAPr ( T ) 

ACC ( I ) =Ur ACTDNi" U L ) -bSs! (I ) 

URXfEC22y iOC', RCf:CC.;;> vROTOX yRPOS<IUUPAREa> yWPERP<I> y 
UTOT (I > ? DNEU (I ) y ACC ( I ) 


CONTINUE 

FOPNfUC-' ^ySE12*5) 

RETURN 

Ei'JD 
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Table A. 6 Variables used in subroutine DOWN 


ACC 

ANGSF 

DAVG(I) 

DFAC 

DNEW(I) 

DOLD(I) 

DT 

FEE 

FN(I) 

FPOS 

HROTO(I) 

PHI 

ROTO (I) 
RPOS(I) 

RSCC(I) 

RTOT(I) 

SPMAG 

SN(1) 

SO(I) 

T 

TOPS 

TDVEL 

WCPARM 

WCPWD(I) 

WMAG 

WN(I) 

WNC(I) 

WNCH(I) 

WNCO(I) 


perceived acceleration vector 
angle between SO and SN 

unit vector in the direction of DOLD + DNEW 
steady-state gain of otolith estimate 
current value of DOWN 
old value of DOWN 

update interval for DOl“?N estimator 

angle between DNEW and SN 

constants for first-order filter 
^-DT/TDPS 

ROTO/2 

FEE*FPOS 

component of WOP perpendicular to SN and DODD 

rotation vector to eliminate integration 
errors 

canal contribution to DO\TO 
RSCC+ROTO 

specific force magnitude 
current otolith specific force estimate 
old otolith specific force estimate 
=TDVEL 

time constant for DOWN position 

time constant for DOWN angular velocity 

magnitude of canal angular velocity estimate 

canal estimate parallel to high frequency 
angular velocity otolith estimate 

angular velocity magnitude 

current canal estimate of angular velocity 

current canal estimate of angular velocity 
not confirmed by otolith estimate 

high frequency portion of WNC 

old WNC 
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Table A. 6 concluded 


WNL(I) 

WOD 

WODM 

WOF{I) 

WOPARM 

WPARE(I) 

WPARM(I) 

WPERP(I) 

WSF(I) 

WSFO(I) 

WTOT(I) 


low frequency portion of WNC 
WSF - WOF 
magnitude of WOD 
low frequency portion of WSF 

magnitude of otolith angular velocity estimate 

canal angular velocity parallel to DNEW - 

canal angular velocity perpendicular to DNEW 

system angular velocity perpendicular to 
DNEW 

angular velocity of otolith estimate 
old WSF 
WPARM + WPERP 
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A. 4 Subroutine library 

The next listing contains the rest of the subroutines 
used by the model. They are mostly self-explanatory. Sub- 
routines STMO and STMC are new routines designed to calculate 
state transition matrices for any given update interval. They 
implement the equations for the systems described in Tables 
A, 7 and A, 8, 



oonoono t-o-cn non rj s-^ cn ooonoonnoonooon 
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SUBROUTINE SVUPD ( X s- T ? If ? S y Y y C s>N j N ) 

STATE UECTOR UPDATE: 

X(NEl4)=T>i<X(QLD + D^SS 
Y(NEW)=C»X(NEW) 

WHERE 

N IS DIMENSION OF STATE UECTOR 
X IS STATE DECTDR 
T IS TRANSITION MATRIX 
D IS DRIVIiVe UECTOR 
S IS STI^5ULUS 

Y IS OUTPUT (AFFERENT FIRING RATE) 
C IS OUTPUT MATRIX 

DIMENSION X(N) yT(NyN) yD(N) ?C(M) yR<9) 

DO 5 1=1 yN 

R(I)=Xa> 

DO 10 1=1 yN 

xa)=na)>Ks 

DO 10 J«1?N 
X(I)=Xa)TTay J);KR( J) 

Y=C(M))KS 
DO 20 1=1 yN 
Y=Y+C<l)^<xa) 

RETURN 

END 


SUBROUTINE NORM (Ay AN) 

AN = UNIT VECTOR IN DIRECTION OF VECTOR A 

DIMENSION A(3)yAH(3) 

AM=SQRT C A ( 1 ) :|<5!<24-A ( 2 ) 5:<'K2+ A ( 3 ) >ic^2 ) 
IF(AM-t.E“03) 5v5y6 
AM=lyR~06 
DO 10 1=1 y 3 • 

0 AN(I)=A(I)/AM 
RETURN 
END 


SUBROU FINE SS!\F ( XH y V y TM y C y GK y N ) 

STEADY-STATE KALMAN FILTER (UPDATE EVERY DT SECONDS) 
XH(NEW) TM-l'XHCnUD T RK>K ( Y-CHcTM;{<XH ) 
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C TM IS TRANSITION MATRIX 

C GK IS KALMAN GAIN MATRIX 

C Y IS SENSOR SYSTEM OUTPUT 

C C IS OUTPUT MATRIX 

C 

DIMENSION XHfN) ?TM<N?N) yCCN) cGKCN) i-S(9) 
DO 40 1=1 ?N 
S(I)=0*0 
DO 40 J=i?N 

40 SCD-SCD+THas-JJJKXHC J) 

EM=0*0 
DO 45 1=1 ?N 
45 EM=EM+S<I)>!<C(I) 

DO 50 J=iyN 

50 XH<J)=S( J)+GK< J)>K(Y-EM> 

RETURN 

END 


SUBROUTINE ROTATE ( A? Rj-AR) 

C 

C .AR = A ROTATED ABOUT R BY AN ANGLE (RAD) 

C EQUAL TO THE MAGNITUDE OF R 

C 

DIMENSION A(3) S.RC3) ?AR(3) ? AP ( 3 ) v APN ( 3 ) 
CALL CROSS (R? Ay AP) 

CALL NORM ( AP y APN ) 

AMAG=SQRT ( A’( 1 ) ;-fc}:<2+A ( 2 ) A ( 3 ) m2 ) 

PHI=SQRT < R ( 1 ) mZ+R < 2 ) C 3 ) m2 ) 

DO 10 1=1 y 3 

10 ■ AR(I)=AMAG>icSIN<PHI)>i{APNa)+COS(PHI )>!<A(I) 

RETURN 
END 


SUBROUTINE COTRN ( A y B ? N y C ) 

C 

C COORDINATE TRANSFORfK 

C FROM HEAD TO SENSOR IF N=0 

C FROM SENSOR TO HEAD IF N=1 

C 

C A = ORIGINAL VECTOR 

C 0 = TRANSFORMED VFOTOR 

C B = TRANSFORilATION MATRIX 

C 



DIMENSION A U) B ( 3 ? 3 ) y C C5 ) 

TF(N> 10?J.0r20 
DO 15 1=1 y 3 

C ( I )=B < I y 1 ) :{<A a >+B < I y 2) >HA ( 2 ) +B a y 3 ) --KA < 3 ) 
GO TO 30 
no 25 1=1 ?3 

C ( I) =B < 1 y I ) >!< A < 1 ) + B ( 2 y I ) A ( 2 ) + B ( 3 y I ) JK A ( 3 ) 

RETURN 

END 


SUBROUT I ME MANG ( A y B y PH I ) 

PHI = ANGLE BETWEEN A AND B 

DIMENSION A(3) yB(3) yAN(3> yBN(3) 

CALL NORIK Ay AN.) 

CALL NORM (By BN) 

X=AN Cl ) :{<BN ( 1 > TAN ( 2 > >!<BN ( 2 ) TAN ( 3 ) >KBN ( 3 ) 

IF(X»GT*1*0) X=1»0 

Y=SQRTa,-X)K:^:2) 

PHI=ATAN2(YyX) 

RETURN 

END 


SUBROUTINE CROSS ( Ay B y C) 
C = A X B 


D J MENS ION A ( 3 ) y B ( 3 ) y C ( 3 ) 
C (1 ) =A-( 2 ) >:-;B ( 3 ) - A ( 3 ) >KB ( 2 ) 
c ( 2 ) =A ( 3 :< ( J ) ~A 1 ) ( 3 ) 

C ( 3 i =A ( 1 > )!CB ( 2 ) -A ( 2 ) T'B ( 1 ) 
RETURN 
END 


ORIGINAL PAGE Ib 
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SUBROUTINE EULER ( F y T y S y CT ) 


OmOINAL PAGE IS 
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C PRODUCE D I RECTI CM COSINE MATRXX (CT) GlC^EH 

C EULER ANGLES (F?T AND S) , 

c ■ . 

DIMENSION CT<3f3) 

CTa»l)«COS(S)«COS<F)-COS<T)>KSIN<F)>KSiN<S> 
CT<2>l)«-<SIN<3);icC03(F)-fC0S(T)H£SIN<p >»COS'<S> 3 
CT<37l)=SIN<T)»SIN<F) 

. CT<l72)=C0S<S)«SIN<F)TC0S(T)iitCQS<F)iKSIM<S> 
CT(272)=C03<T)^tC0S<F))SC0S<S)-SINCS)#SIN<F) 
CT(372)--SIN<T)«C0S<F) 

CT(l73)=SIN<T)>i«SIN<S) 

CT<273)«SIN(T)^cC0S<3) 

. CT(373)=C0S(T) 

.DO 10 1=1 »3 

10 WRITE(227lOO) CKIjI) 7CT<I»2) »CT<I»3) 

100 FORMATC' CT=' »3E15,8> 

RETURN 

END 


SUBROUTINE STHO < DT r N ITP 7 TPQ j TO ) 

C 

C SUBROUTINE TO CALCULATE OTOLITH STATE 

C TRANSITION MATRICES 

C DT - UPDATE INTHRUAL FDR KALMAN FILTER 

C NITP - NUMBER OF SENSOR UPDATES PER DT 

C TPO - 2X2 STH FOR OTOLITH SENSOR UPDATE 

C . TO - 3X3 STM FOR OTOLITH KALMAN FILTER SYSTEM 

C 

DIMENSION TP0(272) 7TQ<373) 

C calculate TPO 

T=DT/NITP 

TPO < 1 7 1 ) = < 200 ♦ .YEXP < - . 2«T > - ♦ 25}C£XP < -200 ♦ #T ) ) /199 ♦ S 
TF0(27i) = (EX?C->2:^T)-EXP(-200*-lcT) )/199*S 
TPO ( 1 7 2 ) =40« < EX? ( -200 . ;^T ) -EXP <-*25KT))/199»S 
TPO<27 2) = (200*-1 cEXPC-200.«T)-*2jS{EXP<-.2^'KT) )/199*3 

c calculate to 

T=DT 

TO<l7l) = <200,*EX?C-»2^T>-*2J}{EXP<-200*)t:T) )/199»3 
T0<2r = < EXP <-.2rf(T)-EXP<-200,>KT))/199,3 

T0(37i3 = <EXP<-200.-4cT> )/39760,2+(EXF<-.2^tT) )/lS9*84 
1 -tEXP<-T> )/159.2 

TO < i 7 2 ) =A01f. K EXP < -200 ♦ ) -EXP ( - ♦ 2:i4T ) ) / i 99 ♦ 3 

TO < 27 2 > = < 200 , .■{<EXP C -200 ♦ :i(T ) - . 2:{cEXP < - . 2ST ) ) /199 . 3 
TQ(37 2) = (£XPC-T> )/159*2-< . 2:icEXP ( - .2«T ) ) /1S9 . 84 
- ( 200 , .'!<.EXP ( -200 ♦ :{cT > ) /39760 ♦ 2 
T0<l73)=0.0 
T0(2.*3)=0*0 


1 



noooonon 


T0(3i.3)=:EXPC-T) 

RETURN 

END 
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SUBROUTINE S.TMC ( DT? NITP 7 TPC? TC ) 


SUBROUTINE. TO CALCULATE ' SEMICIRCULAR CANAL'. 
STATE TRANSIT.ION MATRICES 

DT ~ UPBATE INTERVAL l-'OR KALMAN F'lLTER 
NITP - NUMBER OF SENSOR UPDATES PER DT 
TPC ~ 3X3 STM FOR CANA). SENSOR UPDATE 
TC - 4X4 STM FOR CANAL KALMAN FILTER SYSTEM 


C 


C 


DIMENSION ’TC (4? 4) rTPC<373) 

CALCULATE TPC 
T-=DT/N I TP 

TPC ( 1 7 1 ) = ( ♦ 05576Jf(EXP ( - ♦ 03322 j!cT ) - ♦ 03322)!<EXP < - ♦ 05576)fcT ) ) / * 022S4 
TPC ( 2 f 1 ) =-200 ♦ 033:KEXP ( - . 0557(6;icT) /4 . 50674 
i +200 »05558YEXP(-,03322:iiT)/4. 50725 • 

2- + ♦ 0S9)KEXP ( -199 ► 9990>KT ) /399S2 » 1 IS 

TPC (371 ) =EXP ( -1 99 1 999SJKT ) 739982 , 1 18+EXP ( - ♦ 03322»f) 74 , 50725 
1 -EXP (-♦0SS76>i<T >74,50674 

TPC ( 1 ? 2 ) =- , 37037>if ( EXP (-199, 9998::<T ) 739982 .118+ 

1 EXP ( - , 03322Ji(T ) 74 , 50725'~E:XP ( ~ , 05576>KT > 74 , 50674 ) 

TPC ( 2 7 2 ) =2 , 47492;XEXP ( - , 05576»!T ) -1 , 47448;JcEXP ( - , 03322-')<T ) , 

1 . -,00044523KEXP(-199*99983icT) 

TPC (372) = , 05576515EXP ( - * 05576>KT ) 74 » 50674 - 

1 - , 033225JCEXP ( - , 03322>i(T ) 74 , 50725 

2 ■ -1 99, 9990^i^EXP( -199, 9990 :tjT) 739982, 118 

TPC < 1 7 3 > - , 37037;i< ( , 03322:i<EXP ( - . 03322^<T ) 74 , 50725 

1 +199 , 99985F:EXI-‘ ( -199 , 9 998M<T) 739932 , 1 T8 

2 - ♦ 05576>!{EXP ( - , 05576)i<T ) 74 , 50674 ) 

TPC (273) =-i 7 , 7966;X( , 03496JKEXP ( - , 05S76>f{T)74 . 50674 


1 

2 


- , 0 1 242.KEXF- ( - , 03322>!iT ) 74 , 50725 
-199 , 979^E'AP (-199 , 999S^fcT ) 7399S2 , 118 ) 

TPC ( 3 7 3 .) =1 , 000 445'[<1-:XP (-199, 9998>KT > + , 000244B4-YEXP ( -• , 03522.1? f ) . 
- * OOOoi899;{<EXP ( - , 05576TT ) 


CALCULATE TC 
T=DT 

TC ( 1 7 1 ) = < , 05576KEXP ( - , 03522KT ) - , 033221-.EXP i - , 055761?T .>>7.0 225 >> 
TC ( 2 7 1 ) =-200 , 033KEXP ( - , 05576KT > 74 , 50674 

+200 , 055585ICEXP (-♦ 03322-KT ) 74 , 50725 
+ * 0S9KEXP ( -1 99 , 9998 Y T ) 739982 .118 
TC ( 3 7 1 ) =EXP ( - f.99 , 999Qrr ) 759982 .. 1 1 8 H.LXP ( - , 033221: f ) 7 1 . 50 7::5 
-LXPX - , 055 76:KT ) 74-, 506 >’4 

TC ( 4 7 1 > =EX1 • ( -^5 , tJ >74 788 ,-6+t;Xl ’ ( - ,03322;^T > 722 * 3S65 

-EXP (-1 99 , 9998YT ) 77796506 , 55-EXP ( - , 055761?T 't 7 
TC ( 1 7 2 > =- , 37037)K ( EXP ( - L 99 , 9998:Fr X7.599.82 , L 18+EXP ( - , 0.3 
-EXP ( - , 05576*T ) 74 . 50674 >3 


'}n 

52 


'"k o 

f /i t ‘ 

2 :Ki 


24 

>74-5072 
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TC ( 2 1- 2 ) =2 ♦ 47492>KEXP ( - ♦ 05S765KT ) -1 ♦ 47448>KEXP ( - ♦ 03322«T ) 

1 -♦0004452*EXP(-199t9998>KT) 

TC ( 3 » 2 ) ■-= ♦ 05576^'«EXP < - ♦ 0557 6tT ) /A , 50674 

1 - ♦ 03322>KEXP ( - ♦ 03322>KT ) /4 ♦ 50725 

2 -199»99985j<EXP<-199*9998)icT)/39982>118 
TC C 4 y 20 = ♦ 05576»EXP ( - , 05576>!<T ^ 722 ♦ 2824+ 

1 +199 ♦9998;KEXP( “199 *9998)i{T) 77796506, 55-5»>KEXP (-5 ♦>!cT)/478S« 

2 - , 03322>KEXP ( - , 033225KT ) 722 , 3865 

TC C 1 »- 3 ) = ♦ 37037^ ( , 03322*EXP < - ♦ 03 3 225KT ) 74 , 50725 

1 +199, 9998>KEXP ("199, 9998>KT) 739982 ,118 

2 - , 05576>i?EXP ( “ , 05576>KT ) 74 , 50674 > 

TC (2y 3) =“17, 7966!fc ( ,03496>icEXP(-,05576)i<T >74,50674 

1 -,01242>!<EXP(-,03322;KT)74, 50725 

2 -199, 9998)KEXP( “199, 99983KT) 739982, 118) 

TC ( 3 y 3 ) =1 ♦ 000445^EXP (-199, 999B^T ) + , 000244S4>!cEXP < - , 03322>KT ) 

1 -,0006899:SEXP(“.05576*T) 

TC ( 4 » 3 > =25 , ^EXP ( “5 ♦ >!<T ) 74788 , 6+ , 001 1 045KEXP ( - , 03322SCT ) 722 , 3865 

1 ~, 0031 1!K£XP(-,05576;}:T) 722, 2824 

2 -39999 , 925HEXP ( -199 , 9998)f:T > 77796506 , 55 
TC(l5-4)=0,0 

TC(2v4)=0,0 
■ TC(3y4)=0,0 
TC(4»4)=EXP(-5,5icT) 

RETURN 

END 


STOP 
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Table A. 7 Otolith state equations 


SENSOR UPDATE 


where 


A = 


i = Ax + Bf 
y = Cx + SFR + n 


0 0 
-40. -200.2 


B = 


= [si - a] = 


(s+200) (S+.2) 


0 
1 

s+200. 2 
40 


C = [iSOO IBOOO] 


-1 


KALMAN FILTER UPDATE 

S: = Ax + Bf 
y = Cx + SFR + n 

where 



0 

1 

0 


r 

0 

A = ■ 

. 

o 

1 

-200.2 

1 

B = 

0 


. 0 

0 

-1 


1^ 

C = 

[l800 

18000 

o} 




$ = [si - a] = 1 ^ 

(s+1) (s+200) (S+.2) 

— 

(s+1) (s+200. 2) -(s+1) 1 

40 (s+1) s(s+l) -s 

0 0 (s+200) (s+,2) 


-r "P 
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Table A, 8 Canal state equations 


SENSOR UPDATE 


i = Ax + Bu 
y = Cx + SFR + n 

where 



0 

1 

0 


m • 

0 

A = 

0 

0 

1 

B = 

0 


-.37037 

-.17.7966 

-200.0888 


1 

c = 

-23.5785 

-1131.89 

-6371.86] 




[si - 

(s+199.9998) (s+. 03322) (s+. 05576) 


(s+199.9998) (s+. 08898) 
-.37037 
,37037s 


-(s+200.0888) 1 

s(s+200.0888) -s 

-17.7966(s+.0208) s^ 


KALMAN FILTER UPDATE 


where 


A = 


5: = Ax + Bu 
y = Cx + SFR + n 


0 

.1 

0 

0 


0 

0 

0 

1 

0 

B = 

0 

-.37037 

-17.7966 

-200.0888 

1 


0 

0 

0 

0 

-5 


1 



Table A, 8 concluded 


$ = 


C = [-23.5785 -1131.89 -6371.86 63.662o] 

[si - A1"^ = I 

(s+5) (s+199.9998) (s+. 03322) (s+, 05576) 


X 


(s+5) (s+199.9998) (s+. 08898) 
-.37037 (s+5) 
.37037s(s+5) 

0 


.-(s+200. 0888) (s+5) (s+5) -1 

s (s+5) (s+200, 0888) -s(s+5) s 

-17.7966(3+5) (s+. 0208) s^(s+5) -s^ 

0 0 (s+199.9998) (s+. 03322) 

(s+. 05576) 
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A. 5 Kalman gains subroutine 

The next listing is a program which calculates Kalman 
gains for the otolith system. This program calculates only 
the utricle gains - remember that the saccule gains are twice 
those of the utricle. This iterative routine makes the fol- 
lowing calculations until the Kalman gains reach a steady state: 

1, Calculate state estimate, 

2, Calculate propagated error covariance, 

3, Update state estimate. 

4, Update error covariance. 

5, Calculate error covariance. 

Once steady state gains are obtained (in this case, after 
240 iterations) , they must be tested in the main program for a 
known input-output case. This is for the purpose of tuning 
the model. The following iterative procedure is used: 

1, Run main program with Ormsby update intervals of ,1 
and 1,0 seconds for a known input-output case ( for 
example, a constant yaw acceleration of l,5°/second 
for 120 seconds, then a sustained yaw rate of 180°/ 
second for 120 seconds) . Plot WTOT for this case, 

. 2, Calculate new Kalman gains for the desired intervals. 

3, Run main program with same stimulus for new gains. 

Plot WTOT. 

4, If the plots do not match, vary the input variance. 
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measurement noise variance and input power (QU, QM and 
D) to calculate new gains, 

5. Continue this process until the WTOT plots are similar. 

Note that the gains are changed for the otoliths only. This 
was done for simplicity, since the Kalman filters for the canals 
do not change the afferent firing rates appreciably. 

Table A. 9 lists the variables used in the Kalman gains 
routine and their definitions. 


ORIGINAL PAGE IS 
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CALCULATES KALMAN GAINS FOR OTOLITH SYSTEM 

DIMENSION PX<3y3) ?PP<3 j3> jTM( 3?3) yTH(9) yC<3) »GK(3) yS(3?3) yTT(9) 
DATA C /0»iBO000OOE+O470*180OO000E+O5y0»OO0OOOOOE+0O/ 

DATA PX /0*10000000E-01yO*OOOOOOOOE+OOs-0*OOOOOOOOE+OOf 

1 0*OOOOOOOOE-fOOs-0*10000000E~01s-0»OOOOOOOOE-fOOf 

2 0 ♦ OOOOOOOOE+00 y 0 ♦ OOOOOOOOE+00 y 0 ♦ lOOOOOOOE-0 1/ 

DATA D /*22500000E+00/ 

DATA QU /0»400/ 

DATA QM /12*8000000/ 

DATA DT /♦ 250000000/ 

DATA NIT 7240/ 

CALL ASSIGN ( 30 y 'DKli KALMAN tOTO' ) 

. CALCULATE TRANSITION AND COVARIANCE 
MATRICES , 

CALL STMO(DTyTM) 

WRITE ( 30 y 2) ( (TMCIy J) y 1=1 y3) y J=1 ?3) 

FORMAT<' TRANSITION MATRIX ^ y3E14*7/19Xy3E14,7/19Xy3E14y7) 

CALL ICMO<DTyTT) 

DO 3 JTH=ly9 

TH ( JTH ) =TT < JTH > >!<QU;!<D}K!}:2 

URITE(30y4) <TH(I) yl=ly9) 

FORMATC' COVARIANCE MATRIX ' y 3E14 ♦ 7/19Xy 3E14 »7/19X y 3E14 ♦ 7 ) 


T=0*0 

DO 85 M=lyNIT 

CALCULATION OF S=PX>i<TM TRANSPOSE 

T~M>KDT 
DO 10 1=1 y 3 
DO 10 J=ly3 
S<Iy J)=0*0 
DO 5 K=ly3 

S(IyJ)=S(IyJ) -i-PX ( I y K ) >KTM ( J y K ) 

CONTINUE 

CALCULATION OF PROPAGATED ERROR COVARIANCE MATRIX 
PP=TM5};S4TH - 


IC=0 

DO 20 1=1 y 3 
DO 20 J=ly3 
IF<I*GT*J) GO TO 20 
IC=IC+1 

IFaC*E0*7) GO TO 22 
PPdy J)=TH(IC) 

DO 15 K=ly3 

PP ( 1 y J ) =PP <1 y J ) 4 TM ( I y K ) JKS ( K y J ) 


15 
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TOP 


20 

C 

C 

C 


c 

c 

c 


30 

c 

c 

c 


45 

50 

C 

C 

C 

c 


•jd 

60 

C 

70 


/D 


85 


PP<Ji-I)^PPay J) 


COLCULATIOH OF S <i y 1 ) ^ ( C«PP>!<C+QH ) 


S ( 1 y 1 ) 

DO 25 [-=].:■ i 

S (I .» 2 ) ~PP ( I y 1 ) >KC ( 1 ) +PP < I y 2 > sec < 2 > +PP < I y 3 ) >KC ( 3 ) 
S a y 1) n y 1 ) 4C ( I ) .'KS ( I y 2 ) 

CALCULATION OF KALMAN GAINS GK=^PPS«C/S ( 1 y 1) 

DO 30 I=Ly3 

GK(I)=:Say2>/3a yl) 


CALCULATION OF S (I y J ) = (I=GK)!<C> 

DO 45 1=1 y 3 
DO 45 J=ly3 
SayJ)=-GK(I)S<C< J) 

DO 50 1=1 y 3 
S<lyl>=sayi)-:i. 

calculation of new frror comariance matrix 

P'.<=3.’KPP 


DO 60 I=iy3 
DO 60 J--.i :'3 
PX<IyJ)=0.0 
DG 55 is “~ly 3 

PX (I y J > =S (I y K ) 5KPP ( K y ) +PX ( I y J ) 
PX(Jy.i;>=PX'Ty i) 


Wk{TE(30>70; f y N y SK ( I ) y GK ( 2 ) y GK( 3 > 

FORMAT C " TIME=' yF7 ,2y ' ITERATION NUMBER=" y 
1 T 3 y '■ KALrir.N GA I NS= ' y 3E 14 ♦ 7 ) 


W F'' !i i E s 3 O ‘ 


/ %'y . 


PX-, l?;i. ^ vF’X(.Ly2) yPX<l?3) y PX< 2 y 2 ) y F'X < 2 y 3 ) y PX < 3 7 3 > 


F 0 PMAr( 6 El 4 , 7 'i 

CONTINUE 

STOP. 

END 
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Table A. 9 Variables used in Kalman gains programs 


C(I) 

C matrix (see Table A, 7) 

D 

input power 

DT 

update interval 

GK(I) 

Kalman gains 

NIT 

number of iterations 

PP(I,J) 

propagated error covariance matrix 

PX(I,J) 

system covariance matrix 

QM 

variance of measurement noise 

QU 

power of input noise 

TH(I,J) 

TT*QU*D^ 

TM(I,J) 

state transition matrix 

TT(I,J) 

input covariance matrix 
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A, 6 Kalman gains subroutine library 

The last listing is that of the subroutines called by 
the Kalman gain program. Subroutines STMO and STMC were de- 
scribed in section A. 4, Svibroutine ICMO calculates the oto- 
lith input covariance matrix used by the Kalman gains routine, - 
It implements the following equation: 


where 

= input covariance raatfix 

$ = otolith state transition matrix (see Table A, 7) 

B = otolith B matrix (see Table A. 7) 

Q = variance of measurement noise 

The variables used in these subroutines are defined- in the 
listing. 


n m m 

$ j ^ $ B B-*- dt 


POOB 


^ j 


oeigwalpagbk 

OP POOR QUALIK 



ooooon oononoo 
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SUBROUTINE STHO(DTyTO) 

SUBROUTINE TO CALCULATE' OTOLITH STATE 
TRANSITION MATRICES 

DT - UPDATE INTERNAL FOR KALMAN FILTER 

TO - 3X3 STM FOR OTOLITH KALMAN FILTER SYSTEM 


DIMENSION T0(3»3) 

CALCULATE TO 
T=DT 

TO ( 1 y 1 ) = ( 200 , tEXP < - . 2^T ) - ♦ 2JKEXP ( -200 ♦jKT ) )-/1 99 ♦ 8 
TO ( 2 7 3. > = < EXP < - * 2>KT ) -EXP ( -200 > ^T ) ) /199 ♦ 8 
TO ( 3 y 1 ) = < EXP ( -200 ♦ :^iT ) ) /39760 > 2+ ( EXP ( - » 2^T )) /1 59 * 84 
1 -<EXP(-T) )/159.2 

TO (1 y 2 ) =40-ic ( EXP < -200 . rx ) -EXP < - ♦ 2*T ) ) /1 99 , 8 
TO ( 2 y 2 ) = ( 200 ♦ ^EXP ( -200 > JST ) - ♦ 25KEXP ( - ♦ 2JKT ) ) 7199 ♦ 8 
TQ<3y2) = (EXP(-T) )/lS9.2-< »2^EXP(-*25{cT) ) 71 59^84 
1 - (200 4 >i<EXPC -200 *>}:T) >739760*2 

TQ(ly3)-040 

T0(2y3)“0.0 

T0(3»3)=EXP(-T) 

RETURN 

END 


SUBROUTINE SThC (DT y TC ) 


SUBROUT CNF TO CALCULATE SEMICIRCULAR CANAL 
STATE TRANSITION MATRICES 


DT - UPDATE INTEHUAL FOR KALMAN FILTER 
TC - 4X4 STM FOR CANAL KALMAN FILTER SYSTEM 


DIMENSION TC(4y4> 

CALCULA fE TO 
T--=DT 

TC C ;i. y 1 ) = ( 4 05576;!<EXP ( - , 033227!^ ) - * 03322:KEXP < - * 055764c F ) ) 7 , 0225 4 
TC < 2 y 1 ) =-200 4 033>KEXP ( - » 05576>KT ) 74 * 50674 

1 T200 40555S;IcEXP (-4 03322:icT >74450725 

2 4 . 0894EXP ( - -J, 99 , 99984. F > 739982 * 1 I . B 

TC ( 3 y 1 ) =EXP ( -1.99 * 999S4T ) 739982 ♦ 1 ISTEXP ( - 4 033224T > 74 * 50725 
1 -EXP ( - 4 055764T >74 4 506 74 

TC ( 4 y 1 > =EXi-' ( -5 4 4T > 74738 * 6+EXP ( - » 03322>KT ) 722 * 3065 
1 -EXP ( - i.99 , 'V990TT j 77796506 455-EXP ( - * 0557A::c F > 722 4 2024 

TC ( i y 2 > =- . 37<L3 ?>K( EXP ( - i 99 * 9990^ F ) 739982 ♦ 1184 EXP ( - ♦ 03322‘KT ) 74 * 5072 
1 -EXP ( - 4 05576:K F > /4 * 50vS74 > 

TC ( 2 » 2 > =2 . 474925KE XP t~ , 05S76-i F ) -1 - 47 4 4 85KEXP ( - » 03322>!<T > 
i -4 0004 45r7;<EXPC -199 4 9998 V<cT> 

TC ( 3 y 2 > = 4 0557 '-.xrXP C ~ * 05576Ji;T >74 * S0674 




!-■ V !_• f 


/ 


,03322:!a >74 *50725 



t o j-* 1-^ W W 
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1 


TC<4v2) 

TC <1 ? 3 ) 

TC<2?3)= 

TC<3!-3)^ 

TC<473)- 


TC(1?4) 

TC<2y4> 

TC(3?4) 

TC(4»4) 

RF-ITURM 

END 


-199 » 999B'K£XP ( -19'’* 999«-i<T ) /399B2 . liH 
* 0537641- XP < - . 031-; ^6>KT ) / 22 , 2024+ 

+ 199 , 999Bi:'.i:XP ■' - I 99 . 9990:KT ) /7796506 » 35-L=: ♦ ;KEXP < -S* «T ) /478S . 

- ♦ 03322;i«EXP ( - ♦ 03322)!iT ) 722 ♦ 3865 
37037-.K ( , 03322:^•'EXP ( - » 03322>K T ) /4 ♦ 50725 

+ 199 ♦ 999S-.KEXP ( - L 99 * 99?0>i(T ) 739982 *118 

- * 05576^EXP ( - * 05576>KT ) 74 * 50674 ) 

-17 * 79664: ( *03496^KEXP ( - * 03576>K D 74 ♦ 50674 

- * 01242>i<EXP «; - * 03322 >1<T ) 74 * 50725 
-199* 9998>i<EXP ( -1 99 * 9998::<T > 739982 *118) 

1 * 000445JKEXP ( -199 * 99984:7 ) + * 00024484JKEXP ( - * 033224:7 ) 

- * 00068994iEXP < - *055764:7 ) 

25 * 4^EXP ( -5 - 4< n 7 4788 * 6+ , 001 104«EXP ( - * 033224:7 ) 722 * 3865 

- * 0031 14:EXP < - * 055764:7 ) 722 * 2824 
-39999 * 925KEXP ( -199 * 99984<7 ) 77796506 * 53 
0*0 

0*0 

0*0 

EXP(-5*4:7) 


C 

C 

C 

C 

C 

U 

c 


SUBR0U7INE £CH0<Dry77) 

8UBR0U7I;M£ ro CALCUL67E 07QLI7H INPU7 
CQMARTmNCE finfRiX 

D7 - L‘Prirt7E IHiEROAL FOR K.+Li'IAM FIL7ERS 
77 - XrPUf C8VARIAXCE Hft7RIX 

D1HEN8ICN 77:9) 

7“D7 

77 < 1 ) =-FXP ( - * 4:-i:7 ) >:*9 * 7S51953E-05 + EXP < -1 * 2Tf ) >54V6S/--6£-05 

-EXi'C-Z^O^Xn^Kl *972805‘’'E~05 + 5 >2083J 04E-05 
77 ( 2 ) =~EXP ( “ J . 2-v' r > '+298089E -05 + EXP ( - * 447f '■ ;!ci , 9570367E-05 

+EXP (-2 * 0*7 > + 1'* V728037i£-05 ~ * 0000315E-05 

07035r--03 

( -2 * 0:,.T ' VI , 972no.T/r-05 + EXP ■ -1 * 24:7 .■ *1 * 3099363T-:-05 

27 0937 -03 


77(3)-^ 

=“PXP:-i 

, V K T 


1 

42<'X'2S 

4330I- 

-o 

77f 4)-- 

™ p’ ^7 1 1 ^ 

. 0-1- 1 ' 

V 1 

1. 

-EXPC-, 

4:’. i ) + 

*> 

77<5) = 

="EXP «. -2 

. 0* r '} 

If »*Y 

1 

+2*0'"'7V 

9 '741 

03 

7 r ( 6 ) ■ 

^ -EXi (“2 

, O.V "i ) 

A' 

J* A 

r7(7)- 

-M.O 



77 <8 ■ 

•0.0 



TT(9) = 

=0.0 




' j'k \ 7 * '*“ f 

y 40 > , *^iL 




1 ,05427475E-05 
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STOP — 


RETURN 

END 
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